平差导线代码.docx

B=NaN(45,30);P=NaN(45,45);Si=NaN(19,1);X0=NaN(18,1);
Y0=NaN(18,1);XY=NaN(30,1);S0=NaN(19,1);L=NaN(45,1);
r=15;rou=206265;Li=NaN(26,1);L0=NaN(26,1);
a=NaN(26,1);b=NaN(26,1);c=NaN(26,1);d=NaN(26,1);
j1=NaN(26,1);j2=NaN(26,1);sgm0=6;
X1=NaN(15,1);Y1=NaN(15,1);S1=NaN(19,1);
L1=NaN(26,1);L1dms=NaN(26,3);Sdev=NaN(19,1);
Qx=NaN(15,1);Qy=NaN(15,1);Qxy=NaN(15,1);
K=NaN(15,1);E=NaN(15,1);F=NaN(15,1);Qe=NaN(15,1);
Fe=NaN(15,1);Fai=NaN(15,3);

Li(1,1)=(134+35/60+52.7/3600)/180*pi;
Li(2,1)=(202+19/60+10.7/3600)/180*pi;
Li(3,1)=(129+30/60+14.9/3600)/180*pi;
Li(4,1)=(162+9/60+14.2/3600)/180*pi;
Li(5,1)=(138+43/60+48.6/3600)/180*pi;
Li(6,1)=(175+52/60+30.1/3600)/180*pi;
Li(7,1)=(144+48/60+40.2/3600)/180*pi;
Li(8,1)=(134+33/60+3.1/3600)/180*pi;
Li(9,1)=(189+13/60+5.9/3600)/180*pi;
Li(10,1)=(170+33/60+51.6/3600)/180*pi;
Li(11,1)=(112+44/60+18.3/3600)/180*pi;
Li(12,1)=(171+13/60+58/3600)/180*pi;
Li(13,1)=(146+38/60+42.3/3600)/180*pi;
Li(14,1)=(360-(212+55/60+25.8/3600))/180*pi;
Li(15,1)=(50+26/60+14.2/3600)/180*pi;
Li(16,1)=(360-(297+41/60+39.7/3600))/180*pi;
Li(17,1)=(167+26/60+28.8/3600)/180*pi;
Li(18,1)=(360-(245+3/60+31.1/3600))/180*pi;
Li(19,1)=(91+23/60+26.5/3600)/180*pi;
Li(20,1)=(360-(206+19/60+41.2/3600))/180*pi;
Li(21,1)=(360-(189+32/60+52.5/3600))/180*pi;
Li(22,1)=(66+59/60+34.1/3600)/180*pi;
Li(23,1)=(360-(279+55/60+6.8/3600))/180*pi;
Li(24,1)=(155+58/60+21.4/3600)/180*pi;
Li(25,1)=(96+35/60+25.7/3600)/180*pi;
Li(26,1)=(360-(294+25/60+59.4/3600))/180*pi;

Si(1,1)=45.878;Si(2,1)=25.083;Si(3,1)=58.859;Si(4,1)=33.166;
Si(5,1)=43.223;Si(6,1)=62.642;Si(7,1)=37.399;Si(8,1)=46.764;
Si(9,1)=39.761;Si(10,1)=35.981;Si(11,1)=40.878;Si(12,1)=53.546;
Si(13,1)=45.165;Si(14,1)=64.024;Si(15,1)=44.644;Si(16,1)=56.887;
Si(17,1)=42.365;Si(18,1)=52.129;Si(19,1)=56.626;

X0(1,1)=256.832;Y0(1,1)=288.001;X0(2,1)=267.182;Y0(2,1)=265.153;
X0(3,1)=310.011;Y0(3,1)=224.779;X0(4,1)=307.803;Y0(4,1)=191.667;
X0(5,1)=291.856;Y0(5,1)=151.494;X0(6,1)=236.081;Y0(6,1)=122.978;
X0(7,1)=201.643;Y0(7,1)=108.393;X0(8,1)=155.941;Y0(8,1)=118.303;
X0(9,1)=134.685;Y0(9,1)=151.906;X0(10,1)=110.827;Y0(10,1)=178.840;
X0(11,1)=89.129;Y0(11,1)=213.509;X0(12,1)=119.980;Y0(12,1)=257.274;
X0(13,1)=151.325;Y0(13,1)=289.791;X0(14,1)=251.244;Y0(14,1)=188.915;
X0(15,1)=190.059;Y0(15,1)=212.716;X0(16,1)=133.395;Y0(16,1)=207.687;
X0(17,1)=204.453;Y0(17,1)=252.576;X0(18,1)=213.783;Y0(18,1)=303.863;
%{
X0(1,1)=256.829;Y0(1,1)=287.987;X0(2,1)=267.176;Y0(2,1)=265.120;
X0(3,1)=310.005;Y0(3,1)=224.746;X0(4,1)=307.804;Y0(4,1)=191.653;
X0(5,1)=291.857;Y0(5,1)=151.480;X0(6,1)=236.082;Y0(6,1)=122.964;
X0(7,1)=201.667;Y0(7,1)=108.433;X0(8,1)=155.965;Y0(8,1)=118.343;
X0(9,1)=134.709;Y0(9,1)=151.946;X0(10,1)=110.851;Y0(10,1)=178.880;
X0(11,1)=89.129;Y0(11,1)=213.509;X0(12,1)=119.980;Y0(12,1)=257.274;
X0(13,1)=151.325;Y0(13,1)=289.791;X0(14,1)=251.244;Y0(14,1)=188.915;
X0(15,1)=190.059;Y0(15,1)=212.716;X0(16,1)=133.395;Y0(16,1)=207.687;
X0(17,1)=204.453;Y0(17,1)=252.576;X0(18,1)=213.780;Y0(18,1)=303.849;
%}
%X0(18,1) is the coordinate of point 0 ;
S0(1,1)=sqrt((X0(18,1)-X0(1,1))^2+(Y0(18,1)-Y0(1,1))^2);
S0(14,1)=sqrt((X0(13,1)-X0(18,1))^2+(Y0(13,1)-Y0(18,1))^2);
S0(15,1)=sqrt((X0(11,1)-X0(16,1))^2+(Y0(11,1)-Y0(16,1))^2);
S0(16,1)=sqrt((X0(15,1)-X0(16,1))^2+(Y0(15,1)-Y0(16,1))^2);
S0(17,1)=sqrt((X0(15,1)-X0(17,1))^2+(Y0(15,1)-Y0(17,1))^2);
S0(18,1)=sqrt((X0(18,1)-X0(17,1))^2+(Y0(18,1)-Y0(17,1))^2);
S0(19,1)=sqrt((X0(4,1)-X0(14,1))^2+(Y0(4,1)-Y0(14,1))^2);
for i=1:12
S0(i+1,1)=sqrt((X0(i,1)-X0(i+1,1))^2+(Y0(i,1)-Y0(i+1,1))^2);
end
%the angle operation

a(1,1)=Y0(2,1)-Y0(1,1); b(1,1)=X0(2,1)-X0(1,1);
c(1,1)=Y0(18,1)-Y0(1,1); d(1,1)=X0(18,1)-X0(1,1);
for i=2:12
a(i,1)=Y0(i+1,1)-Y0(i,1); b(i,1)=X0(i+1,1)-X0(i,1);
c(i,1)=Y0(i-1,1)-Y0(i,1); d(i,1)=X0(i-1,1)-X0(i,1);
end
a(13,1)=Y0(18,1)-Y0(13,1); b(13,1)=X0(18,1)-X0(13,1);
c(13,1)=Y0(12,1)-Y0(13,1); d(13,1)=X0(12,1)-X0(13,1);
% the next is the 14th angle ;
a(14,1)=Y0(1,1)-Y0(18,1); b(14,1)=X0(1,1)-X0(18,1);
c(14,1)=Y0(13,1)-Y0(18,1); d(14,1)=X0(13,1)-X0(18,1);
a(15,1)=Y0(16,1)-Y0(11,1); b(15,1)=X0(16,1)-X0(11,1);
c(15,1)=Y0(10,1)-Y0(11,1); d(15,1)=X0(10,1)-X0(11,1);
a(16,1)=Y0(12,1)-Y0(11,1); b(16,1)=X0(12,1)-X0(11,1);
c(16,1)=Y0(16,1)-Y0(11,1); d(16,1)=X0(16,1)-X0(11,1);
a(17,1)=Y0(11,1)-Y0(16,1); b(17,1)=X0(11,1)-X0(16,1);
c(17,1)=Y0(15,1)-Y0(16,1); d(17,1)=X0(15,1)-X0(16,1);
a(18,1)=Y0(16,1)-Y0(15,1); b(18,1)=X0(16,1)-X0(15,1);
c(18,1)=Y0(17,1)-Y0(15,1); d(18,1)=X0(17,1)-X0(15,1);
a(19,1)=Y0(17,1)-Y0(15,1); b(19,1)=X0(17,1)-X0(15,1);
c(19,1)=Y0(14,1)-Y0(15,1); d(19,1)=X0(14,1)-X0(15,1);
a(20,1)=Y0(14,1)-Y0(15,1); b(20,1)=X0(14,1)-X0(15,1);
c(20,1)=Y0(16,1)-Y0(15,1); d(20,1)=X0(16,1)-X0(15,1);
a(21,1)=Y0(15,1)-Y0(17,1); b(21,1)=X0(15,1)-X0(17,1);
c(21,1)=Y0(18,1)-Y0(17,1); d(21,1)=X0(18,1)-X0(17,1);
a(22,1)=Y0(17,1)-Y0(18,1); b(22,1)=X0(17,1)-X0(18,1);
c(22,1)=Y0(13,1)-Y0(18,1); d(22,1)=X0(13,1)-X0(18,1);
a(23,1)=Y0(1,1)-Y0(18,1); b(23,1)=X0(1,1)-X0(18,1);
c(23,1)=Y0(17,1)-Y0(18,1); d(23,1)=X0(17,1)-X0(18,1);
a(24,1)=Y0(15,1)-Y0(14,1); b(24,1)=X0(15,1)-X0(14,1);
c(24,1)=Y0(4,1)-Y0(14,1); d(24,1)=X0(4,1)-X0(14,1);
a(25,1)=Y0(14,1)-Y0(4,1); b(25,1)=X0(14,1)-X0(4,1);
c(25,1)=Y0(3,1)-Y0(4,1); d(25,1)=X0(3,1)-X0(4,1);
a(26,1)=Y0(5,1)-Y0(4,1); b(26,1)=X0(5,1)-X0(4,1);
c(26,1)=Y0(14,1)-Y0(4,1); d(26,1)=X0(14,1)-X0(4,1);

for i=1:26
if(a(i,1)>0&&b(i,1)>0)
j1(i,1)=atan(a(i,1)/b(i,1));
else if(a(i,1)>0&&b(i,1)<0)
j1(i,1)=atan(a(i,1)/b(i,1))+pi;
else if(a(i,1)<0&&b(i,1)<0)
j1(i,1)=atan(a(i,1)/b(i,1))+pi;
else
j1(i,1)=atan(a(i,1)/b(i,1))+2*pi;
end
end
end
if(c(i,1)>0&&d(i,1)>0)
j2(i,1)=atan(c(i,1)/d(i,1));
else if(c(i,1)>0&&d(i,1)<0)
j2(i,1)=atan(c(i,1)/d(i,1))+pi;
else if(c(i,1)<0&&d(i,1)<0)
j2(i,1)=atan(c(i,1)/d(i,1))+pi;
else
j2(i,1)=atan(c(i,1)/d(i,1))+2*pi;
end
end
end
L0(i,1)=j1(i,1)-j2(i,1);
if(L0(i,1)<0)
L0(i,1)= L0(i,1)+2*pi;
end
end

for i=20:45
L(i,1)=Li(i-19,1)-L0(i-19,1);
L(i,1)=L(i,1)*rou;
end

B=zeros(45,30);
B(1,21)=-(X0(1,1)-X0(18,1))/S0(1,1);
B(1,22)=-(Y0(1,1)-Y0(18,1))/S0(1,1);
B(1,1)=(X0(1,1)-X0(18,1))/S0(1,1);
B(1,2)=(Y0(1,1)-Y0(18,1))/S0(1,1);
for i=2:10
B(i,2*i-3)=-(X0(i,1)-X0(i-1,1))/S0(i,1);
B(i,2*i-2)=-(Y0(i,1)-Y0(i-1,1))/S0(i,1);
B(i,2*i-1)=(X0(i,1)-X0(i-1,1))/S0(i,1);
B(i,2*i)=(Y0(i,1)-Y0(i-1,1))/S0(i,1);
end
for i=1:19
L(i,1)=(Si(i,1)-S0(i,1))*1000;
end
B(11,19)=-(X0(11,1)-X0(10,1))/S0(11,1);
B(11,20)=-(Y0(11,1)-Y0(10,1))/S0(11,1);

B(12,23)=(X0(12,1)-X0(11,1))/S0(12,1);
B(12,24)=(Y0(12,1)-Y0(11,1))/S0(12,1);

B(13,23)=-(X0(13,1)-X0(12,1))/S0(13,1);
B(13,24)=-(Y0(13,1)-Y0(12,1))/S0(13,1);
B(13,25)=(X0(13,1)-X0(12,1))/S0(13,1);
B(13,26)=(Y0(13,1)-Y0(12,1))/S0(13,1);

B(14,25)=-(X0(18,1)-X0(13,1))/S0(14,1);
B(14,26)=-(Y0(18,1)-Y0(13,1))/S0(14,1);
B(14,21)=(X0(18,1)-X0(13,1))/S0(14,1);
B(14,22)=(Y0(18,1)-Y0(13,1))/S0(14,1);

B(15,27)=(X0(16,1)-X0(11,1))/S0(15,1);
B(15,28)=(Y0(16,1)-Y0(11,1))/S0(15,1);

B(16,27)=-(X0(15,1)-X0(16,1))/S0(16,1);
B(16,28)=-(Y0(15,1)-Y0(16,1))/S0(16,1);

B(17,29)=(X0(17,1)-X0(15,1))/S0(17,1);
B(17,30)=(Y0(17,1)-Y0(15,1))/S0(17,1);

B(18,29)=-(X0(18,1)-X0(17,1))/S0(18,1);
B(18,30)=-(Y0(18,1)-Y0(17,1))/S0(18,1);
B(18,21)=(X0(18,1)-X0(13,1))/S0(18,1);
B(18,22)=(Y0(18,1)-Y0(13,1))/S0(18,1);

B(19,7)=(X0(4,1)-X0(14,1))/S0(19,1);
B(19,8)=(Y0(4,1)-Y0(14,1))/S0(19,1);%the rim is over;

B(20,1)=rou*((Y0(2,1)-Y0(1,1))/(S0(2,1)^2)-(Y0(18,1)-Y0(1,1))/(S0(1,1)^2));
B(20,2)=-rou*((X0(2,1)-X0(1,1))/(S0(2,1)^2)-(X0(18,1)-X0(1,1))/(S0(1,1)^2));
B(20,3)=-rou*((Y0(2,1)-Y0(1,1))/(S0(2,1)^2));
B(20,4)=rou*((X0(2,1)-X0(1,1))/(S0(2,1)^2));
B(20,21)=rou*(Y0(18,1)-Y0(1,1))/(S0(1,1)^2);
B(20,22)=-rou*((X0(18,1)-X0(1,1))/(S0(1,1)^2));
for i=2:9
B(i+19,2*i-1)=rou*((Y0(i+1,1)-Y0(i,1))/(S0(i+1,1)^2)-(Y0(i-1,1)-Y0(i,1))/(S0(i,1)^2));
B(i+19,2*i)=-rou*((X0(i+1,1)-X0(i,1))/(S0(i+1,1)^2)-(X0(i-1,1)-X0(i,1))/(S0(i,1)^2));
B(i+19,2*i-3)=rou*((Y0(i-1,1)-Y0(i,1))/(S0(i,1)^2));
B(i+19,2*i-2)=-rou*((X0(i-1,1)-X0(i,1))/(S0(i,1)^2));
B(i+19,2*i+1)=-rou*((Y0(i+1,1)-Y0(i,1))/(S0(i+1,1)^2));
B(i+19,2*i+2)=rou*((X0(i+1,1)-X0(i,1))/(S0(i+1,1)^2));
end
B(29,19)=rou*((Y0(11,1)-Y0(10,1))/(S0(11,1)^2)-(Y0(9,1)-Y0(10,1))/(S0(10,1)^2));
B(29,20)=-rou*((X0(11,1)-X0(10,1))/(S0(11,1)^2)-(X0(9,1)-X0(10,1))/(S0(10,1)^2));
B(29,17)=rou*((Y0(9,1)-Y0(10,1))/(S0(10,1)^2));
B(29,18)=-rou*((X0(9,1)-X0(10,1))/(S0(10,1)^2));

B(30,19)=rou*((Y0(10,1)-Y0(11,1))/(S0(11,1)^2));
B(30,20)=-rou*((X0(10,1)-X0(11,1))/(S0(11,1)^2));
B(30,23)=-rou*((Y0(12,1)-Y0(11,1))/(S0(12,1)^2));
B(30,24)=rou*((X0(12,1)-X0(11,1))/(S0(12,1)^2));

B(31,23)=rou*((Y0(13,1)-Y0(12,1))/(S0(13,1)^2)-(Y0(11,1)-Y0(12,1))/(S0(12,1)^2));
B(31,24)=-rou*((X0(13,1)-X0(12,1))/(S0(13,1)^2)-(X0(11,1)-X0(12,1))/(S0(12,1)^2));
B(31,25)=-rou*((Y0(13,1)-Y0(12,1))/(S0(13,1)^2));
B(31,26)=rou*((X0(13,1)-X0(12,1))/(S0(13,1)^2));

B(32,25)=rou*((Y0(18,1)-Y0(13,1))/(S0(14,1)^2)-(Y0(12,1)-Y0(13,1))/(S0(13,1)^2));
B(32,26)=-rou*((X0(18,1)-X0(13,1))/(S0(14,1)^2)-(X0(12,1)-X0(13,1))/(S0(13,1)^2));
B(32,23)=rou*((Y0(12,1)-Y0(13,1))/(S0(13,1)^2));
B(32,24)=-rou*((X0(12,1)-X0(13,1))/(S0(13,1)^2));
B(32,21)=-rou*(Y0(18,1)-Y0(13,1))/(S0(14,1)^2);
B(32,22)=rou*((X0(18,1)-X0(13,1))/(S0(14,1)^2));

B(33,21)=rou*((Y0(1,1)-Y0(18,1))/(S0(1,1)^2)-(Y0(13,1)-Y0(18,1))/(S0(14,1)^2));
B(33,22)=-rou*((X0(1,1)-X0(18,1))/(S0(1,1)^2)-(X0(13,1)-X0(18,1))/(S0(14,1)^2));
B(33,25)=rou*((Y0(13,1)-Y0(18,1))/(S0(14,1)^2));
B(33,26)=-rou*((X0(13,1)-X0(18,1))/(S0(14,1)^2));
B(33,1)=-rou*(Y0(1,1)-Y0(18,1))/(S0(1,1)^2);
B(33,2)=rou*((X0(1,1)-X0(18,1))/(S0(1,1)^2));

B(34,19)=rou*((Y0(10,1)-Y0(11,1))/(S0(11,1)^2));
B(34,20)=-rou*((X0(10,1)-X0(11,1))/(S0(11,1)^2));
B(34,27)=-rou*((Y0(16,1)-Y0(11,1))/(S0(15,1)^2));
B(34,28)=rou*((X0(16,1)-X0(11,1))/(S0(15,1)^2));

B(35,27)=rou*((Y0(16,1)-Y0(11,1))/(S0(15,1)^2));
B(35,28)=-rou*((X0(16,1)-X0(11,1))/(S0(15,1)^2));
B(35,23)=-rou*((Y0(12,1)-Y0(11,1))/(S0(12,1)^2));
B(35,24)=rou*((X0(12,1)-X0(11,1))/(S0(12,1)^2));

B(36,27)=rou*((Y0(11,1)-Y0(16,1))/(S0(15,1)^2)-(Y0(15,1)-Y0(16,1))/(S0(16,1)^2));
B(36,28)=-rou*((X0(11,1)-X0(16,1))/(S0(15,1)^2)-(X0(15,1)-X0(16,1))/(S0(16,1)^2));

B(37,29)=rou*((Y0(17,1)-Y0(15,1))/(S0(17,1)^2));
B(37,30)=-rou*((X0(17,1)-X0(15,1))/(S0(17,1)^2));
B(37,27)=-rou*((Y0(16,1)-Y0(15,1))/(S0(16,1)^2));
B(37,28)=rou*((X0(16,1)-X0(15,1))/(S0(16,1)^2));

B(38,29)=-rou*((Y0(17,1)-Y0(15,1))/(S0(17,1)^2));
B(38,30)=rou*((X0(17,1)-X0(15,1))/(S0(17,1)^2));

B(39,27)=rou*((Y0(16,1)-Y0(15,1))/(S0(16,1)^2));
B(39,28)=-rou*((X0(16,1)-X0(15,1))/(S0(16,1)^2));

B(40,29)=rou*((Y0(15,1)-Y0(17,1))/(S0(17,1)^2)-(Y0(18,1)-Y0(17,1))/(S0(18,1)^2));
B(40,30)=-rou*((X0(15,1)-X0(17,1))/(S0(17,1)^2)-(X0(18,1)-X0(17,1))/(S0(18,1)^2));
B(40,21)=rou*((Y0(18,1)-Y0(17,1))/(S0(18,1)^2));
B(40,22)=-rou*((X0(18,1)-X0(17,1))/(S0(18,1)^2));

B(41,21)=rou*((Y0(17,1)-Y0(18,1))/(S0(18,1)^2)-(Y0(13,1)-Y0(18,1))/(S0(14,1)^2));
B(41,22)=-rou*((X0(17,1)-X0(18,1))/(S0(18,1)^2)-(X0(13,1)-X0(18,1))/(S0(14,1)^2));
B(41,25)=rou*((Y0(13,1)-Y0(18,1))/(S0(14,1)^2));
B(41,26)=-rou*((X0(13,1)-X0(18,1))/(S0(14,1)^2));
B(41,29)=-rou*(Y0(17,1)-Y0(18,1))/(S0(18,1)^2);
B(41,30)=rou*((X0(17,1)-X0(18,1))/(S0(18,1)^2));

B(42,21)=rou*((Y0(1,1)-Y0(18,1))/(S0(1,1)^2)-(Y0(17,1)-Y0(18,1))/(S0(18,1)^2));
B(42,22)=-rou*((X0(1,1)-X0(18,1))/(S0(1,1)^2)-(X0(17,1)-X0(18,1))/(S0(18,1)^2));
B(42,29)=rou*((Y0(17,1)-Y0(18,1))/(S0(18,1)^2));
B(42,30)=-rou*((X0(17,1)-X0(18,1))/(S0(18,1)^2));
B(42,1)=-rou*(Y0(1,1)-Y0(18,1))/(S0(1,1)^2);
B(42,2)=rou*((X0(1,1)-X0(18,1))/(S0(1,1)^2));

B(43,7)=rou*(Y0(4,1)-Y0(14,1))/(S0(19,1)^2);
B(43,8)=-rou*((X0(4,1)-X0(14,1))/(S0(19,1)^2));

B(44,7)=rou*((Y0(14,1)-Y0(4,1))/(S0(19,1)^2)-(Y0(3,1)-Y0(4,1))/(S0(4,1)^2));
B(44,8)=-rou*((X0(14,1)-X0(4,1))/(S0(19,1)^2)-(X0(3,1)-X0(4,1))/(S0(4,1)^2));
B(44,5)=rou*((Y0(3,1)-Y0(4,1))/(S0(4,1)^2));
B(44,6)=-rou*((X0(3,1)-X0(4,1))/(S0(4,1)^2));

B(45,7)=rou*((Y0(5,1)-Y0(4,1))/(S0(5,1)^2)-(Y0(14,1)-Y0(4,1))/(S0(19,1)^2));
B(45,8)=-rou*((X0(5,1)-X0(4,1))/(S0(5,1)^2)-(X0(14,1)-X0(4,1))/(S0(19,1)^2));
B(45,9)=-rou*((Y0(5,1)-Y0(4,1))/(S0(5,1)^2));
B(45,10)=rou*((X0(5,1)-X0(4,1))/(S0(5,1)^2));
%µ¥Î»»¯³ÉͳһµÄºÁÃ×
for i=20:45
for j=1:30
B(i,j)=B(i,j)/1000;
end
end
%P matrix
P=zeros(45,45);
for i=1:19
P(i,i)=sgm0^2/(S0(i,1)/2000*1000)^2;
end
for i=20:45
P(i,i)=sgm0^2/36;
end
XY=inv(B'*P*B)*B'*P*L;
V=B*XY-L;sgm1=sqrt(V'*P*V/r);
Q=inv(B'*P*B);
Dx=sgm1^2*Q;
for i=1:15
X1(i,1)=XY(2*i-1,1)/1000;
Y1(i,1)=XY(2*i,1)/1000;
end
for i=1:10
X1(i,1)= X1(i,1)+ X0(i,1);
Y1(i,1)= Y1(i,1)+ Y0(i,1);
end
X1(11,1)= X1(11,1)+ X0(18,1);
Y1(11,1)= Y1(11,1)+ Y0(18,1);
for i=12:13
X1(i,1)= X1(i,1)+ X0(i,1);
Y1(i,1)= Y1(i,1)+ Y0(i,1);
end
X1(14,1)= X1(14,1)+ X0(16,1);
Y1(14,1)= Y1(14,1)+ Y0(16,1);
X1(15,1)= X1(15,1)+ X0(17,1);
Y1(15,1)= Y1(15,1)+ Y0(17,1);
% question 3
S1(1,1)=sqrt((X1(11,1)-X1(1,1))^2+(Y1(11,1)-Y1(1,1))^2);
S1(11,1)=sqrt((X1(10,1)-X0(11,1))^2+(Y1(10,1)-Y0(11,1))^2);
S1(12,1)=sqrt((X0(11,1)-X1(12,1))^2+(Y0(11,1)-Y1(12,1))^2);
S1(13,1)=sqrt((X1(12,1)-X1(13,1))^2+(Y1(12,1)-Y1(13,1))^2);
S1(14,1)=sqrt((X1(13,1)-X1(11,1))^2+(Y1(13,1)-Y1(11,1))^2);
S1(15,1)=sqrt((X1(14,1)-X0(11,1))^2+(Y1(14,1)-Y0(11,1))^2);
S1(16,1)=sqrt((X1(14,1)-X0(15,1))^2+(Y1(14,1)-Y0(15,1))^2);
S1(17,1)=sqrt((X1(15,1)-X0(15,1))^2+(Y1(15,1)-Y0(15,1))^2);
S1(18,1)=sqrt((X1(15,1)-X1(11,1))^2+(Y1(15,1)-Y1(11,1))^2);
S1(19,1)=sqrt((X1(4,1)-X0(14,1))^2+(Y1(4,1)-Y0(14,1))^2);
for i=1:9
S1(i+1,1)=sqrt((X1(i,1)-X1(i+1,1))^2+(Y1(i,1)-Y1(i+1,1))^2);
end

%¼ÆËã¸÷½Ç¶ÈµÄ¹Û²âÖµµÄƽ²îÖµ
%******¿ÉÄÜ»áÓÐ360¶ÈµÄ²îÒì*****
a(1,1)=Y1(2,1)-Y1(1,1); b(1,1)=X1(2,1)-X1(1,1);
c(1,1)=Y1(11,1)-Y1(1,1); d(1,1)=X1(11,1)-X1(1,1);
for i=2:9
a(i,1)=Y1(i+1,1)-Y1(i,1); b(i,1)=X1(i+1,1)-X1(i,1);
c(i,1)=Y1(i-1,1)-Y1(i,1); d(i,1)=X1(i-1,1)-X1(i,1);
end
a(10,1)=Y0(11,1)-Y1(10,1); b(10,1)=X0(11,1)-X1(10,1);
c(10,1)=Y1(9,1)-Y1(10,1); d(10,1)=X1(9,1)-X1(10,1);
a(11,1)=Y1(12,1)-Y0(11,1); b(11,1)=X1(12,1)-X0(11,1);
c(11,1)=Y1(10,1)-Y0(11,1); d(11,1)=X1(10,1)-X0(11,1);
a(12,1)=Y1(13,1)-Y1(12,1); b(12,1)=X1(13,1)-X1(12,1);
c(12,1)=Y0(11,1)-Y1(12,1); d(12,1)=X0(11,1)-X1(12,1);
a(13,1)=Y1(11,1)-Y1(13,1); b(13,1)=X1(11,1)-X1(13,1);
c(13,1)=Y1(12,1)-Y1(13,1); d(13,1)=X1(12,1)-X1(13,1);
a(14,1)=Y1(1,1)-Y1(11,1); b(14,1)=X1(1,1)-X1(11,1);
c(14,1)=Y1(13,1)-Y1(11,1); d(14,1)=X1(13,1)-X1(11,1);
a(15,1)=Y1(14,1)-Y0(11,1); b(15,1)=X1(14,1)-X0(11,1);
c(15,1)=Y1(