translatenum.m

RAIM 完好性分析

function [xs,ys,zs]=translatenum(sate,k,Xs,Ys,Zs,flag)

%*********************************
% ** 获取指定可见星坐标
% ** sysnum 组合系统数目,exp:gps sysnum=1; gps/galileo sysnum = 2; gps/galileo/bd sysnum = 3 
% **********************************

switch flag
    case 1
        mat_h=[1,1,1,1,2,2,2,2,3,3,3,3,4,4,4,4,5,5,5,5,6,6,6,6];
        mat_l=[1,2,3,4,1,2,3,4,1,2,3,4,1,2,3,4,1,2,3,4,1,2,3,4];
    case 2
        mat_h=[1,1,1,1,1,1,1,1,1,2,2,2,2,2,2,2,2,2,3,3,3,3,3,3,3,3,3];
        mat_l=[1,2,3,4,5,6,7,8,9,1,2,3,4,5,6,7,8,9,1,2,3,4,5,6,7,8,9];
    case 3
        mat_h=[1,1];
        mat_l=[1,2];
end
x=[];y=[];z=[];

for i=1:k
   h=mat_h(1,sate(1,i));
   l=mat_l(1,sate(1,i));
   x=[x,Xs(h,l)];
   y=[y,Ys(h,l)];
   z=[z,Zs(h,l)];
end
xs=x(1,:)';
ys=y(1,:)';
zs=z(1,:)';