fadian.m

多基时差雷达定位算法。以雷达测量误差分布规律入手

function T=fadian(oy)
global M;
E=eye(8,8);%生成8*8单位阵
for i=2:9
    B(i-1,:)=A(i,1:8)-A(1,1:8); %2-9行各指标对第一行的差值
    c1(i-1)=A(i,9)/A(i,10)-A(1,9)/A(1,10);%2-9行负荷率对第一行的差值
    c2(i-1)=A(i,10)-A(i-1,10);%2-9行煤耗对第一行的差值
end 
for j=1:9
    t(j)=A(j,9)/A(j,10);  %负荷率
end
b1=c1';b2=c2';
X=B\b1; %各指标对负荷率的影响系数
Y=B\b2; %各指标对煤耗的影响系数
AA1=diag(B(1,:));%生成对角阵，对角元素为第2行与第1行各指标差值
AA2=diag(B(2,:));%生成对角阵，对角元素为第3行与第1行各指标差值
AA3=diag(B(3,:));%生成对角阵，对角元素为第4行与第1行各指标差值
AA4=diag(B(4,:));%生成对角阵，对角元素为第5行与第1行各指标差值
AA5=diag(B(5,:));%生成对角阵，对角元素为第6行与第1行各指标差值
AA6=diag(B(6,:));%生成对角阵，对角元素为第7行与第1行各指标差值
AA7=diag(B(7,:));%生成对角阵，对角元素为第8行与第1行各指标差值
AA8=diag(B(8,:));%生成对角阵，对角元素为第9行与第1行各指标差值
AAA=[AA1^6,AA1^5,AA1^4,AA1^3,AA1^2,AA1^1,E;
    AA2^6,AA2^5,AA2^4,AA2^3,AA2^2,AA2^1,E;
    AA3^6,AA3^5,AA3^4,AA3^3,AA3^2,AA3^1,E;
    AA4^6,AA4^5,AA4^4,AA4^3,AA4^2,AA4^1,E;
    AA5^6,AA5^5,AA5^4,AA5^3,AA5^2,AA5^1,E;
    AA6^6,AA6^5,AA6^4,AA6^3,AA6^2,AA6^1,E;
    AA7^6,AA7^5,AA7^4,AA7^3,AA7^2,AA7^1,E;
    AA8^6,AA8^5,AA8^4,AA8^3,AA8^2,AA8^1,E];%系数矩阵
BBB=[E;E;E;E;E;E;E;E];
XXX=AAA\BBB;
XA=XXX(1:8,:);
XB=XXX(9:16,:);
XC=XXX(17:24,:);
XD=XXX(25:32,:);
XF=XXX(33:40,:);
XG=XXX(41:48,:);
XH=XXX(49:56,:);
AA=diag(oy);
oz=oy*(XA*AA^6+XB*AA^5+XC*AA^4+XD*AA^3+XF*AA^2+XG*AA+XH);
T=-oz*X;