testuser_orbit.m

GPS/GALILEO/BEIDOU兼容接收机自主完好性检测程序

t = 1000;
a=6378137;          %椭球长半轴
f=1/298.257;          %扁平率
g=9.78;             %重力加速度
omiga_ie=7.2921150e-5;   % 地球自转加速度（rad/s）
ang2rad=pi/180;      %角度到弧度的转换系数
rad2ang=180/pi;      %弧度到角度的转换系数
h=5000;                            %高度维持在6000m
lon=6.9437e-005*t+116*ang2rad;           %从经度116，纬度40，起飞，平行赤道飞行
lat=40*ang2rad;
RN=a*(1+f*sin(lat)^2);
R1=RN+h;
RM=a*(1-2*f+3*f*sin(lat)^2);
R2=RM+h;  
ae=0;
an=0;
au=0;
vu=0;
vn=0;
ve=340;
Fe=ae+2*omiga_ie*(vu*cos(lat)-vn*sin(lat))+ve*(vu-vn*tan(lat))/R1+sqrt(2*(5e-6*g)^2/3600)*randn(1);
Fn=an+2*omiga_ie*ve*sin(lat)+(ve*ve*tan(lat)+vn*vu)/R1+sqrt(2*(5e-6*g)^2/3600)*randn(1);
Fu=au-2*omiga_ie*ve*cos(lat)-(ve*ve+vn*vn)/R1+g+sqrt(2*(5e-6*g)^2/3600)*randn(1);
user=[lon lat h 340 0 0 Fe Fn Fu]';
RN_0=a*(1+f*sin(user(2))^2);
R1=RN_0+user(3);
RM_0=a*(1-2*f+3*f*sin(user(2))^2);
R2=RM_0+user(3);
user(10)=R1;   %卯酉圈
user(11)=R2;     %子午圈
user