30 lines
407 B
Matlab
30 lines
407 B
Matlab
clc
|
|
clear
|
|
h1=-1.004;
|
|
h2=1.516;
|
|
h3=2.512;
|
|
h4=1.520;
|
|
HA=12.013;
|
|
HB=10.013;
|
|
h=[h1,h2,h3,h4]'
|
|
s1=2;
|
|
s2=1;
|
|
s3=2;
|
|
s4=1.5;
|
|
s=[s1,s2,s3,s4]'
|
|
A=[1,1,-1,0;0,1,1,-1];
|
|
w1=h1+h2-h3+Ha-HB;
|
|
w2=h2-h4;
|
|
w=[w1;w2];
|
|
P=diag(1./S)
|
|
Naa=A*inv(P)*A';
|
|
Ka=-inv(P)*A'*Ka;
|
|
H=h+V;
|
|
if H(1,1)+H(2,1)-H(3,1)+HA-HB == 0 && H(2,1)-H(4,1)==0
|
|
disp('正确')
|
|
else
|
|
disp('错误')
|
|
end
|
|
disp('平差结果');
|
|
HC=HA+H(1,1)
|
|
HD=HA+H(1,1)+H(4,1) |