f_coordi_trans.m

多目标跟踪 (三维)-算法matlab编制

function mes_rt= f_coordi_trans(mes,mes_total)
%极坐标转换为直角坐标
%mes格式（径向距离，方位角，俯仰角,径向速度)
mes_rt=[];
for i=1:mes_total
    temp=mes(1,i)*cos(mes(3,i));
    temp1=temp*cos(mes(2,i));
    temp2=temp*sin(mes(2,i));
    temp3=mes(1,i)*sin(mes(3,i));
    temp4=[temp1 temp2 temp3];
    mes_rt=[mes_rt temp4];
end