bd_sat.m

RAIM 完好性分析

function [xs,ys,zs] = bd_sat(t)
%*********************************
% ** 北斗星座 (地心地固坐标) 
% **********************************
%模拟卫星在地心地固坐标系中的运动，参数t是运行时间，单位秒（s），距离的单位（km）
we = 0;%7.2921151467e-5*360/(2*pi);        %0;%为了让坐标不随地球转动，在此让地球转速we=0
trans=2*pi/360;      %用tran将度换算弧度
bomigaG0=0;      %参考时间的格林威治子午线赤经
%-------------GEO--------
a=42378137;      %a是轨道半径
e=0.0;           %e是轨道离心率
i=0;             %i是轨道倾角
bomiga=0;%每个星的升交点赤经
w=0.0;           %w近地点角，在此取0
v0=[80,140];    %每个星的真近点角初始值
v=we*t+v0; 
bomigaG=(bomigaG0+we*t); %因为地球的自转，坐标系也有一个旋转
r=a.*(1-e.^2)./(1+e.*cos(trans*v));             %公式
xs(1:2)=r.*cos(trans*(v+w)).*cos(trans*(bomiga-bomigaG))-r.*sin(trans*(v+w)).*sin(trans*(bomiga-bomigaG)).*cos(trans*i);        %在地心地固坐标系下的轨道
ys(1:2)=r.*cos(trans*(v+w)).*sin(trans*(bomiga-bomigaG))+r.*sin(trans*(v+w)).*cos(trans*(bomiga-bomigaG)).*cos(trans*i);        %轨道方程
zs(1:2)=r.*sin(trans*(v+w)).*sin(trans*i);