navstar.m

一个关于卫星导航方面的ekf滤波程序

function ns1=navstar(s1)%format goes like this: function output=fcnName(input)
% EKF- Generate navigation data format
% Convert the RA/dec form of navstars into the form of [x,y,z].

ra=s1(1)+s1(2)/60+s1(3)/3600;
ra=ra*15*pi/180;
dec=s1(4)+s1(5)/60+s1(6)/3600;
dec=dec*pi/180;

ns_x=cos(dec)*cos(ra);
ns_y=cos(dec)*sin(ra);
ns_z=sin(dec);

ns1=[ns_x,ns_y,ns_z];% vector output