平差导线代码.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);enda(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&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&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&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 L1(i,1)=j1(i,1)-j2(i,1); if(L1(i,1)0) L1(i,1)= L1(i,1)+2*pi; endend%*for i=1:26 L1dms(i,:)=degrees2dms(rad2deg(L1(i,1);end%*for i=1:19 Sdev(