卡西欧5800p三维坐标计算程序(交点法)

卡西欧5800p三维坐标计算程序(交点法) ROAD-000

Deg: Fix 3:20 →DimZ↙ "ZS[1],FS[2]"?J

If J=l: Then Gotoθ:Else Goto 4: IfEnd↙

Lblθ↙ "XS"?U:"YS"?V↙ Lbl1↙ "KP"?P↙

Prog "ROAD- DATA "↙ M+0→N↙

Prog "ROAD- SUB1 "↙

Prog "ROAD- SUB2 "↙

Cls：

＂XP=＂:Locate6,1,F:

（X坐标在第一行第六列显示）

＂YP=＂:Locate5,2,G:（Y坐标在第二行第五列显示）＂ZH=＂:Locate4,3,P:Locate12,3,＂FWJ=＂: （桩号在第三行第四列显示）Z▶DMS◢ Prog＂SQX-JDF＂（方位角在第四行显示）If U=θ:Then Goto 3:Else Pol(F-U,G-V):IfEnd↙

Lbl2↙ If J<θ: Then J+360→J: IfEnd↙

"A1=":J▶DMS◢ "Dl=":I◢ Lbl3↙

"DANGLE"(输入边距夹角)?H:If H=θ:Then Goto1:IfEnd:?D(输入边距)↙"XB=":F+DCos(Z+H)→Z[11]:

"YB=":G+DSin(Z+H)→Z[12]:

Cls：

＂XB=＂:Locate6,1,Z[11]: （X坐标在第一行第六列显示）＂YB=＂:Locate5,2, Z[12]:（Y坐标在第二行第五列显示）＂ZH=＂:Locate4,3,P:Locate9,3,＂BJ=＂:Locate12,3,D: （桩号在第三行第四列显示）Prog＂SQX-JDF＂

If U=θ:Then Goto 3:Else Pol(Z[ll]-U,Z[12]-V):IfEnd↙

Goto 2↙ Lbl4↙ "XB"?U:"YB"?V:"KP"?P↙

Lbl5↙ Prog"ROAD-DATA"↙ M+0→N↙

Prog "ROAD-SUB1 "↙ Prog "ROAD-SUB2 "↙

Z-90→A↙ (V-G)Cos(A)-(U-F)Sin(A)→H↙

If Abs(H)>0.0001:ThenP+H→P:Goto5:IfEnd↙

"K=":P◢ "D=":(G-V)÷Sin(A)→D◢ Goto4↙

ROAD-SUBl

If O<θ: Then -1→W：Else1→W:IfEnd: WO→A↙

B2÷24÷R- B^(4)÷2688÷R^(3)+B^(6)÷506880÷R^(5)→Z[6]↙

C2÷24÷R-C^(4)÷2688÷R^(3)+C^(6)÷506880÷R^(5)→Z[7]↙

B÷2- B^(3)÷240÷R2+B^(5)÷34560÷R^(4)→Z[8]↙

C÷2- C^(3)÷240÷R2+C^(5)÷3456÷R^(4)→Z[9]↙

Z[8]+(R+Z[7]-(R+Z[6])Cos(A))÷Sin(A)→Z[18]↙

Z[9]+(R+Z[6]-(R+Z[7])Cos(A))÷ Sin(A)→T↙

RAπ÷180+(B+C)÷2→L↙ L-B-C→Z[19]↙

(R+(Z[6]+Z[7])÷2)÷Cos(A÷2)-R→E↙

K-Z[18]→Z[1]↙ Z[1]+B→Z[2]↙ Z[2]+ Z[19]÷2→Z[3]↙

Z[1]+L- C→Z[4]↙ Z[4]+C→Z[5]↙

ROAD-SUB2

X→Z[18]cos(M)→F:Y- Z[18]Sin(M)→G↙

If P>Z[1]:Then Goto 1: IfEnd↙

X→F:Y→G:P-K→Z[16]:θ→Z(17]:M→A:M→Z:Goto 5↙

Lbl1↙ If P>Z[2]: Then Goto2: IfEnd↙

P-Z[1]→L:L→Z[14]: B→Z[15]: Prog "ROAD- SUB3"↙

WZ[17]→Z[17]:M→A:M+90WL2÷(BRπ)→Z: Goto5↙

Lbl2↙ If P>Z[4]: Then Goto 3: IfEnd↙

P-Z[1]→L:90(2L-B)÷R÷π→A↙

RSin(A)+Z[8]→Z[16]:W(R(l-Cos(A))+Z[6])→Z[17]↙

M+WA→Z: M→A: Goto 5↙

Lbl3↙ If P>Z[5]:Then Goto 4: IfEnd↙

Z[5]-P→L:L→Z[14]:C→Z[15]: Prog "ROAD- SUB3"↙

X+TCos(N)→F: Y+TSin(N)→G↙

-Z[16]→Z[16]:WZ[17]→Z[17]:N→A:N-90WL2÷(CRπ)→Z:Goto5↙Lbl4↙

X→F:Y→G:P-Z[5]+T→Z[16]:θ→Z[17]:N→A:N→Z:Goto5↙

Lbl5↙

F+Z[16]Cos(A)-Z[17]Sin(A)→F↙

G+Z[16]sin(A)+Z[17]Cos(A)→G↙

If Z<θ: Then Z+360 →Z: IfEnd↙

ROAD-SUB3

If Z[ 14] =θ:Thenθ→Z[16]:θ→Z[l7]:Else↙

Z[14]-Z[14]^(5)÷40÷(RZ[15])2+Z[l4]^(9)÷3456÷(RZ[l5])^(4)→Z[16]↙

Z[14]^(3)÷6÷(RZ[15])-Z[14]^(7)÷336÷(RZ[15])^(3)+