f_coordi_trans.m

来自「雷达目标跟踪matlab源程序 希望对大家能够有所帮助」· M 代码 · 共 13 行

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