自编交点法计算平曲线坐标.docVIP

交点法计算平曲线坐标“一”为主程序，二三四为子程序。主程序可根据工程平曲线参数修改（红色部分）. 一．WHT-1 26→DimZ “X(JD)”？X: “Y(JD)”？Y : “FWJ ” ？M “ANGLE” ？O: ？R: “LS1”？B : “LS2” ？C : “K(JD)”？K M+O→N PrOg“ROAD-SUB1” “T1=”：S ◢ “T2=”：T ◢ “L=”：L ◢ “LY=”：Q ◢ “E=”：E ◢ “K(ZH)=”：Z[1] ◢ “K(HY)=”：Z[2] ◢ “K(QZ)=”：Z[3] ◢ “K(YH)=”：Z[4] ◢ “K(HZ)=”：Z[5] ◢ “XS”？U: “YS”？V LbI0 “KP”？P PrOg“ROAD-SUB2” “XP=”：F ◢ “YP=”：G ◢ “BP=”：Z DMS ◢ If U=0：ThenGoTo2:EISe p0I(F-U,G-V):If End LbI1 If J＜0：ThenJ+360→J: If End “A1=”：J DMS ◢ “D1=”：I ◢ LbI2 “D ANGLE”？H:If H=0：ThenGoTo0：If End：？D “XB=”：F+DCos(Z+H) →Z[11] ◢ “YB=”：G+DSin(Z+H) →Z[12] ◢ If U=0: ThenGoTo2:EISe PoI(Z[11]-U,Z[12]-V): If End GoTo1 二．WHT-SUB1 If O＜0：Then-1→W: EISel→W: If End:WO→A B^2÷24÷R- B^ (4) ÷2688÷R^ (3)+ B^ (6) ÷506880÷R^ (5) →Z[6] C^2÷24÷R- C^ (4) ÷2688÷R^ (3)+ C^ (6) ÷506880÷R^ (5) →Z[7] B÷2- B^ (3) ÷240÷R^2 + B^ (5) ÷34560÷R^ (4) →Z[8] C÷2- C^ (3) ÷240÷R^2 + C^ (5) ÷34560÷R^ (4) →Z [9] Z[8]+(R+Z[7]-(R+Z[6])Cos(A)) ÷Sin(A) →S Z[9]+(R+Z[6]-(R+Z[7])Cos(A)) ÷Sin(A) →T RA∏÷180+(B+C) ÷2→L L-B-C→Q (R+(Z[6]+Z[7]) ÷2) ÷Cos(A÷2)-R→E K-S→Z[1] Z[1]+B→Z[2] Z[2]+Q÷2→Z[3] Z[1]+L-C→Z[4] Z[4]+C→Z[5] 三．WHT-SUB2 X-SCos(M) →Z[21]:Y-Ssin(M) →Z[22] X+TCos(N) →Z[23]:Y+Tsin(N) →Z[24] If P＞Z[1]: ThenGoTo1：If End Z[1]-P→L X-(S+L)Cos(M) →F Y-(S+L)Sin(M) →G M→Z: GoTo5 LbI 1 If P＞Z[2]:Then GoTo2：If End P-Z[1] →L:L→Z[14]:B→Z[15]:Prog“ROAD-SUB3 Z[21]+Z[16]Cos(M)-WZ[17]Sin(M) →F Z[22]+Z[16]Sin(M)+WZ[17]Cos(M) →G M+90WL^2÷(BR∏) →Z GoTo5 LbI 2 If P＞Z[4]: ThenGoTo3：If End P-Z[1] →L:90(2L-B) ÷R÷∏→Z[13] RSin(Z[13])+Z[8] →Z[16]:R(1-Cos(Z[13]))+Z[6] →Z[17] Z[21]+Z[16]COS(M)-WZ[17]Sin(M) →F Z[22]+Z[16]Sin(M)+WZ[17]Cos(M) →G M+WZ[13] →Z GoTo5 LbI 3 If P＞Z[5]: ThenGoTo4：If End Z[5]-P→L：L→Z[14]:C→Z[15]:Prog“ROAD-SUB3 Z[23]-Z[16]Cos(N)-WZ[17]Sin(N) →F Z[24]-Z[16]Sin(N)+WZ[17]COs(N) →G N-90WL^2÷(CR∏) →Z GoTo5 LbI 4 P-Z[5] →L X+(T+L)Cos(N) →F Y+(T+L)Sin(N) →G N→Z LbI 5 If Z＜0 :ThenZ+360→Z:If End 四．WHT-SUB3 If Z[14]=0:Then0→Z[16]:0→Z[17]:Else Z[14]-Z[14]^(5)÷40÷(RZ[15])^2+Z[14]^(9)÷3456÷(RZ[15])^ (4)→Z[16] Z[14]^(3)