中线坐标计算改进版.doc

公路中线坐标计算改进版王庆军ZHYHZ（主程序）1. Deg:Fix3:12DimZ2. “ZHYHZ:Z1-N”?Z93. IfZ9=0:Then “X1”?D:“Y1”?E:“X2”?F:“Y2”?G:“X3”?H:“Y3”?V:“JD2”?W:“Ls1”?L:“Ls2”?T:“R”?R:IfEnd4. Cls:“1:KBXY:2:XYKB”?Z10:Z10=2Goto35. “CZX”?X:“CZY”?Y6. Lbi0:“Kp”?K7. Z90Prog“XLZB”:Prog“AA”8. Lbi1:90Z:“JJ=”?Z:Z=0Goto0:“JB=”?B9.If B0：Then Rec（AbsB，Q+Z180）：Else Rec（AbsB，Q+Z）：IfEnd10.M+IM：N+JN11.Pol（MX，NY）：Prog“BB”：JJ: II12.1C:Prog“ZHYHZ-XS”13.Lbi2:0S:“S=”?S:I-SSIf Abs(s)0.01:Then Goto2:Else Goto1:EfEnd14.Lbi3:“Xb=”?M:“Yb=”?N:“Kp=”?K15.0S:0B:MZ11:NZ1216.Lbi4:Z90Prog“XLZB”:Prog“AA”17.Pol(Z11-M,Z12-N):If J0:Then J+360J:IfEnd:JJ:II18.ICos(J-Q)S:K+SK:If Abs(S)0.0001:Then Goto4:IfEnd19.ISin(J-Q)B20.2C:Prog“ZHYHZ-XS”:Goto3 ZHYHZ-XS（显示子程序）1. Cis:If C=1:Then “X=”:Locate4,1,M:“Y=”:Locate4,2,N:Fix4:“FJ=”:Locate4,3,J:“HD=”:Locate4,4,I2. If C=2:Then “K=”:Locate4,2,K:“B=”:Locate4,3,BIfEndXLZB（路由器）1. If Z9=1:Then Prog“XLZB-1”:Goto1:IfEnd2. If Z9=2:Then Prog“XLZB-2”:Goto1:IfEnd3. If Z9=3:Then Prog“XLZB-3”:Goto1:IfEnd4. If Z9=4:Then Prog“XLZB-4”:Goto1:IfEnd5. Cls:Locate4,2,“ZHYHZ-ERROR”Sotp6. Lbi1XLZB-1（数据库）1.IfKThenGotoA：ElseIfKAndKThenGotoBElseIfKAndK：ThenGotoC：ElseIfKThenGotoNEfEndEfEndEfEnd(N个)2.Cls:Locate 6,2,“KPOUT” Stop3LbiA(X1)D(Y1)E(X2)F(Y2)G(X3)H(Y3)V(JD2)W(LS1)L(LS2)T(R)RGoto04LbiB(X1)D(Y1)E(X2)F(Y2)G(X3)H(Y3)V(JD2)W(LS1)L(LS2)T(R)RGoto05LbiC(X1)D(Y1)E(X2)F)(Y2)G(X3)H(Y3)V(JD2)W(LS1)L(LS2)T(R)RGoto0NLbiN(X1)D(Y1)E(X2)F(Y2)G:(X3)H(Y3)V(JD2)W(LS1)L(LS2)T(R)RGoto0Lbi0AA（坐标计算子程序）1.Pol（FD，GE）：Prog“BB”：JO：Pol（HF，VG）：Prog“BB”：JU UOZ1：Z1Abs（Z1）P L2（24R）L4（2688R3）Z54.L2L3（240R2）Z65.T2（24R）T4（2688R3）Z76.T2T3（240R2）Z87.（R+Z5）tan（Abs（Z12）+Z6（Z5Z7）Sim（AbsZ1）Z38.（R+Z7）tan（Abs（Z12）+Z8+（Z5Z7）Sim（AbsZ1）Z49.RAbs（Z1）180+（L+T）2Z2：Prog“CC”BBIf J0：Then 360+JJ：IfEndCC If KWZ3：Then Goto1：Else If KWZ3And KWZ3+L：Then Goto2：Else If KWZ3+L And KWZ3+Z2T：Then Goto3：Else If KWZ3+Z2T And KWZ3+Z2：Then Goto4：Else If KWZ3+Z2：Then Goto5：IfEnd：IfEnd：IfEnd：IfEnd：IfEnd Lbi1：WZ3KS：F（Z3+S）CosOM：G（Z3+S）SimON：OQ：GotoA Lbi2：KW+Z3S：RLZ1：Prog“KK”：Prog“JJ”：GotoA Lbi3：KW+Z3S：90（2SL）（R）Z1：（L2L3（240R2）+RSimZ1I：L2（24R）+R（1CosZ1）J：Prog“JJ”：GotoA Lbi4：WZ3+Z2KS：RTZ1：Prog“KK”：F+（Z4I）CosU+JCos（U+90P）M：G+（Z4I）SimU+JSim（U+90P）N：UPZ1Q：GotoA Lbi5：KW+Z3Z2S：F+（Z4+S）CosUM：G +（Z4+S）SimUN：UQ：GotoA LbiAJJ F（Z3I）CosO+JCos（O+90P）M：G（Z3I）SimO+JSim（O+90P）NO+PZ1QKK SS5（40Z12）+S9（3456Z14）S13（599040Z16）IS3（6Z1）S7（336Z13）+S11（4220Z15）J 90S2(Z1)Z1说明：本程序可计算前HZ后ZH上所有任意中桩，边桩座标：提问：X？Y？为测站点坐标Z？为边桩与路线交角K？为待求点桩号B？为距离中桩距离（左“-B”，右“+B”）D，E为前一交点桩座标，F，G为本交点桩座标，H，V为后交点桩座标，W为本交点桩号，L为本曲线前缓和曲线长，T为本曲线后缓和曲线长，R为本曲线半径，C为后曲线直缓点桩号。输出：M，N为待求点K所对应的X，Y坐标，J为方位角，I为放线平距。当平曲线无缓和曲线时L，T均输入零。本程序中的数学模型是根据公路工程计算手册中桩大地坐标而建立，为了简化程序，本程序采用了一个主程序ZHYHZ和若干个子程序组成。匝道全线贯通程序第三版王庆军TYQXJS（主程序）1. Deg:Fix3:6Dim2. “TYQXJS:1-N”?Z53. IfZ5=0:Then “X0”?U:“Y0”?V:“S0”?O:“F0”?G:“Ls”?H:“Rs”?P:“Rn”?R:“Q”?Q:If End4. Cls:“1:SZXY,2:XYSZ”?Z6:Z6=2Goto25. “CZX=”?M:“CZY=”?N6. Lbi0:“Kp”K7. Z50Prog“TYQXJS-DATA”:Abs(K-O)W8. Prog“SUB1”9. Lbi1:90Z:“JJ”Z:Z=0Goto0:“JB”B10. If B0:Then Res(AbsB,Z4+Z-180):Else Rec(AbsB,Z4+Z):IfEnd11. X+IX:Y+JY12. Pol(X-M,Y-N):J0J+360J13. 1T:Prog“TYQXJS-XS”14. Lbi3:“S=”?S:I-SS If Abs(S)0.01:Then Goto3:Else Goto1:IfEnd15. Lbi2:“X”?X:“Y”?Y:“Kp”?K16. Z50Prog“TYQXJS-DATA”17. Prog“SUB2”18. 2T:Prog“TYQXJS-XS”SUB1（坐标正算子程序）11PC：（P-R）（2HPR）D：180E2.0.1739274226A:0.3260725774Z1:0.0694318442S:0.3300094782L:1-LZ2:1-SZ33.U+W(ACos(G+QESW(C+SWD)+Z1Cos(G+QELW(C+LWD)+Z1Cos(G+Z2QEW(C+Z2WD)+A Cos(G+Z3QEW(C+Z3WD)X4.V+W(ASin(G+QESW(C+SWD)+Z1Sin(G+QELW(C+LWD)+Z1Sin(G+Z2QEW(C+Z2WD)+A Sin(G+Z3QEW(C+Z3WD)Y5.G+QEW(C+WD)Z4SUB2（反算里程和边距子程序）1 XI：YJ2 Abs(J-V)Cos(G-90)-(I-U)Sin(G-90)W:0B3 Lbi0:Prog”SUB1”4 (G-90)+QEW(C+WD)L5 (J-Y)CosL-(I-X)SinLB6 If AbsB10(-6):Then Goto1:Else W+BW:Goto0:IfEnd7 Lbi1:0B:Prog“SUB1”8 (J-Y)Sin(Z4+90)B9 O+WK:BBTYQXJS-DATA（路由器）1.If Z5=1:Then Prog“AZD”:Goto1:IfEnd2.If Z5=2:Then Prog“BZD”:Goto1:IfEnd3.If Z5=3:Then Prog“CZD”:Goto1:IfEnd4.If Z5+4:Then Prog“DZD”:Goto1:IfEnd5.Cls:Locate 4,2,“TYQXJS-ERROR” Stop6.Lbi1TYQXJS-XS（显示子程序）1. Cls:If T=1:Then “X=”:Locate 4,1,X:“Y=”:Locate 4,2,Y:Fix4:“FJ=”:Locate 4,3,J:“HD”:Locate 4,4,I EfEnd2. If T=2:Then “K=”:Locate 4,1,K:“B=”:Locate 4,2,B IfEndBZD(以B,C匝道为例的数据库)1 If K102.511:Then GotoA:Else If K102.511 And K272.465:Then GotoB:Else If K272.465:Then GotoC:IfEnd:IfEnd:IfEnd2LbiA:2904.645P:58R:102.511H:1Q:0O:3030137.263U:506569.752V:3191139.7G:Goto03LbiB:58P:58R:169.954H:1Q:102.511O:3030228.025U:506530.533V:105018.1G:Goto04LbiC:58P:1045R:76.371H:1Q:272.465O:3030218.405U:506645.484V:1784343.5G:Goto05Lbi0CZD1.If K212.645:Then GotoA:Else If K212.645 And K314.337:Thed GotoB:Else If K314.337 And K469.526:Then GotoC:Else IfK469.526:Then GotoD:IfEnd:IfEnd:IfEnd:IfEnd2.LbiA:4171.441P:4171.441R:312.645H:1Q:0O:3029949.692U:506489.917V:363306G:Goto03.LbiB:4171.441P:62R:101.692H:1Q:212.645O:3030117.214U:506620.855V:392820.6G:Goto04.LbiC:62P:62R:155.189H:1Q:314.337O:3030173.052U:506702.128V:87931.2G:Goto05.LbiD:62P:2457.229R:185.628H:1Q:469.5260:3030063.238U:506744.577V:2303420.7G:Goto06.Lbi0本程序为怀通公路竹田BC匝道程序，由一个主程序（TYQXJS）和两个子程序正算子程序（SUB1）,反算子程序（SUB2)及匝道数据库组成，可以根据曲线段直线，圆曲线，缓和曲线（完整或非完整）的线元要素（起点坐标，起点里程，起点切线方位角，线元长度，起点曲率半径，止点曲率半径）及里程边距或坐标，对该曲线段范围内任意里程中边桩坐标进行正反算。1使用说明：以道路中线的前进方向区分左右，当线元往左偏时，Q=-1,当线元往右偏时，Q=1,当线元为直线时，Q=0.当所求点位于中线时B=0，当位于中线左线时B取负值，当位于中线右线时B取正值。当线元为直线时，其起点，止点的曲率半径为无穷大，以10的45次方代替。当线元为圆曲线时，无论其起点，止点与什么线元相接，其曲率半径均等于圆弧的半径。当线元为完整缓和曲线时，起点或止点分别与直线相接时，曲率半径为无穷大，以10的45次方代替，其分别与圆曲线相接时，曲率半径等于圆曲线半径。当线元为非完整缓和曲线时，起点或止点分别与直线相接时，曲率半径等于设计规定的值，其分别与圆曲线相接时，曲率半径等于圆曲线半径。输入与显示说明输入部分SZXYXYSZF?选择计算方式，输1表示进