vertical.m

此算法为多传感器目标定位法

function [outx,outy,outz]=vertical(M,X,Y,Z,B,C)
%veical采用垂线定位法
%M为传感器个数（这里仿真M=2，3，4）
%X,Y,Z,B,C为五个向量，每个向量的元素个数为M，分别表示每个传感器x,yz三个坐标位置和方位角和俯仰角
%(outx,outy,outz)为目标位置估计
%传感器个数为2
if M==2
    [outx,outy,outz,fangchax,fangchay,fangchaz]=two_sensor_vertical(X,Y,Z,B,C);
%传感器个数为3
else if M==3
        [outx,outy,outz]=three_sensor_vertical(X,Y,Z,B,C);
%传感器其个数为4
    else if M==4
            [outx,outy,outz]=four_sensor_vertical(X,Y,Z,B,C);
 end
end
end