利用真数（级数展开）公式和垂距趋近正反算曲线程序(for 4850P)

一、程序编制原理和功能：利用真数（级数展开）公式和点至法线垂距逐步迭代趋近单向收敛原理；功能：1、正算任意角度、偏距点坐标；2、反算任意角度的中桩里程和偏距。
二、程序主体：
1、主程序：ZFS-ZHSH
T"1.KDF=>XY,2.XY=>KD":A"QD"B"ZD"R"1/R0"V"1/RN"C"X0"D"Y0"E"F0"Q"-1,+1":T=1=>Goto 1:≠>Goto 2△
Lbl 1:{LIF}:L"K=":I"DP=":F"ANG=":Prog "SIM2":"XI=":X=X:Pause 0:"YI=":Y=Y▲"FW=":W→DMS▲Goto 1
Lbl 2:{XY}:XY:O=X:U=Y:L=A+Abs ((Y-D)cos(E+F"ANG="-180)-(X-C)sin(E+F-180))
Lbl 3:I=0:Prog "SIM2":Z=(U-Y)cos(W+F-180)-(O-X)sin(W+F-180):AbsZ<1E-4=>Goto 4:≠>L=L+Z:Goto 3△
Lbl 4:I=0:Prog "SIM2":Z=(U-Y)/sin(W+F)
Lbl 5:"K=":L:Pause 0:"DP=":Z▲Goto 2

2、子程序：SIM2
H=L-A:T=(V-R) / 2 /(B-A):W=E+Q(RH+TH²)×180/π
P=H-R²H^3/6-TRH^4/4+(R^4-12T²)×H^5/120+TR^3H^6/36+T²R²H^7/28+T^3RH^8/48+T^4H^9/216
S=RH²/2+TH^3/3-R^3H^4/24-TR2H^5/10+(R^5-60T2R)×H^6/720+(TR^4-4T^3)×H^7/168+T²R^3H^8/96+T^3R²H^9/108+T^4RH^10/240+T^5H^11/1320
X=C+PcosE-QS sinE+Icos (W+F)
Y=D+PsinE+QS cosE+Isin (W+F)

三、使用说明：
   QD—起点里程；
   ZD—终点里程；
   1/Rθ、1/RN—起、终点曲率（直线输入零）
   Xθ、Yθ—起点坐标；
   Fθ—起点方位角；
    Q—曲线偏向（左-1、右+1）；
   ANG—线外左右测点连线与路线方向斜交右角；
   X、Y—待求点中桩坐标
   XI、YI—计算点中边桩坐标。
   FW—切线方位角
   K= —正算时为计算点里程；反算时为测点对应中桩里程
   DP—正算时为支距（左负右正）；反算时为测点对应于中线某一角度ANG的支距（若ANG=90则为垂支距，左负右正）。