judge_errsate.asv

来自「RAIM 完好性分析」· ASV 代码 · 共 36 行

function [errsate,sate,flag]=judge_errsate(kk_gps,kk_galileo,kk_beidou,H,y,num)

%*********************************
% ** %最大似然估计法故障星
% **  kk_gps,kk_galileo,kk_beidou分别为三个系统可见星
% **********************************


kk = kk_gps+kk_galileo+kk_beidou;

for i = 1:kk
    b(i) = solve_bi(kk,H,y,i);
end
buffer = [];
[m,n] = max(b);

errsate = num(1,n);
for k= 1:1:kk
    if(k==n)
        continue;
    else
        buffer = [buffer num(1,k)];
    end
end
sate = buffer;
flag = 0;

if(n <= kk_gps)
    flag = 1;
end
if((n>kk_gps)&&(n<=(kk_gps+kk_galileo)))
    flag = 2;
end
if(n>kk_gps+kk_galileo)
    flag = 3;
end