缓和曲线中桩坐标和切线方位角计算程序（PC-E500）
适用于第一缓和曲线、第二缓和曲线、卵型曲线（R1>R2或R2>R1）。该方法无须知道起点切线方位角，但要已知终点坐标。如果想用它求起点切线方位角，只要输入的桩号C比A大1毫米就可以了。
1.输入信息
A=起点桩号；B=终点桩号；XA，YA=起点坐标；XB，YB=终点坐标；R1=起点半径；R2=终点半径；K=左偏为-1，右偏为1；C=AB之间任意点桩号，A＜C≤B。直缓（缓直）点半径输1E50；Y$输“Y”，结束，回车继续下一个桩号的计算。

2.输出信息
XP，YP=桩号为C 点的坐标；AT=桩号为C 点的切线方位角（度.分秒）。

3.源程序：
10:INPUT"A=";A:INPUT"B=";B:INPUT"XA=";XA:INPUT"YA=";YA:INPUT"XB=";XB:INPUT"YB=";YB
15:INPUT "R1=";R1:INPUT "R2=";R2:INPUT "K=";K
20:G=ABS (R1*R2*(B-A)/(R1-R2)):S=SQR ((YB-YA)^2+(XB-XA)^2)
21:P0=ASN ((YB-YA)/S)
23:IF (XB-XA)<0 THEN P0=180-P0
24:IF (XB-XA)>0 AND P0<0 THEN P0=P0+360
25:IF R1< SPAN>
26:Z=1:M=G/R1
30:L=B-A:GOSUB 1040
31:P1=PP
35:INPUT "C=";C:L=C-A
40:GOSUB 1040
50:P2=P1-PP:P3=P0-K*P2
60:XP=XA+DP*COS P3:YP=YA+DP*SIN P3
70:P4=180*(M*L+Z*L^2/2)/G/PI :AT=P3+K*(P4-PP)
80:PRINT "XP=";XP:PRINT "YP=";YP:PRINT "AT=";DMS AT
100:INPUT "END?";Y$
110:IF Y$="Y" THEN END
120:GOTO 35
1040:X=L-L^3*(M*M/3+Z*M*L/4+L*L/20)/(2*G^2)+L^5*(M^4/5+Z*M^3*L/3+3*M^2*L^2/14+Z*M*L^3/16+L^4/144)/24/G^4
1050:Y1=L^2*(M+Z*L/3)/2/G-L^4*(M^3/2+3*Z*M^2*L/5+M*L^2/4+Z*L^3/28)/12/G^3
1060:Y2=L^6*(M^5/3+5*Z*M^4*L/7+5*M^3*L^2/8+5*Z*M^2*L^3/18+M*L^4/16+Z*L^5/176)/240/G^5
1070:Y=Y1+Y2
1080:DP=SQR (X^2+Y^2)
1090:PP=ATN (Y/X)
1095:RETURN
结束

[ 本帖最后由 wyg0509 于 2011-12-13 23:24 编辑 ]