get_slopemax.m

来自「RAIM 完好性分析」· M 代码 · 共 11 行

function slopemax=get_slopemax(H,k,sysnum)
%得出SLOPEmax的值
freedom = k-3-sysnum;
A=inv(H'*H)*H';
B=H*A;
slopebuffer=[];
for i=1:k
    slope=sqrt((A(1,i)^2+A(2,i)^2)*(freedom)/(1-B(i,i)));
    slopebuffer = [slopebuffer,slope];
end
slopemax=max(slopebuffer(1,:));