公路中线坐标计算改进版 ZHYHZ(主程序)1
Deg:Fix3:12→DimZ2
“ZHYHZ:Z[1-N]”
→Z[9]↙3
IfZ[9]=0:Then “X1”
D:“Y1”
E:“X2”
F:“Y2”
G:“X3”
H:“Y3”
V:“JD2”
W:“Ls1”
L:“Ls2”
R:IfEnd↙4
Cls:“1:KB→XY:2:XY→KB”
→Z[10]:Z[10]=2=>Goto3↙5
X:“CZY”
Lbi0:“Kp”
Z[9]>0=>Prog“XLZB”:Prog“AA”↙8
Lbi1:90→Z:“JJ=”
Z:Z=0=>Goto0:“JB=”
If B≤0:Then Rec(AbsB,Q+Z-180):Else Rec(AbsB,Q+Z):IfEnd↙10
M+I→M:N+J→N↙11
Pol(M-X,N-Y):Prog“BB”:J→J: I→I↙12
1→C:Prog“ZHYHZ-XS”↙13
Lbi2:0→S:“S=”
S:I-S→S▲If Abs(s)≥0
01:Then Goto2:Else Goto1:EfEnd↙14
Lbi3:“Xb=”
M:“Yb=”
N:“Kp=”
0→S:0→B:M→Z[11]:N→Z[12]↙16
Lbi4:Z[9]﹥0=>Prog“XLZB”:Prog“AA”↙17
Pol(Z[11]-M,Z[12]-N):If J≤0:Then J+360→J:IfEnd:J→J:I→I↙18
ICos(J-Q)→S:K+S→K:If Abs(S)>0
0001:Then Goto4:IfEnd↙19
ISin(J-Q)→B↙20
2→C:Prog“ZHYHZ-XS”:Goto3↙ ZHYHZ-XS(显示子程序)1
Cis:If C=1:Then “X=”: