利用Simpson公式和垂距趋近正反算曲线程序

利用Simpson公式和垂距趋近正反算曲线程序
一、程序编制原理和功能：
1、原理：利用Simpson公式和点至主点法线垂距逐步迭代趋近单向收敛原理
2、功能：a、正算任意角度、偏距点坐标；b、反算任意角度的中桩里程和偏距。
二、程序主体：
1、主程序：ZFS
T"1.KDF=>XY,2.XY=>KD":A"QD"B"ZD"R"1/R0"V"1/RN"C"X0"D"Y0"E"F0":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
N=6：T=（V－R）÷（B－A）：H=（L－A）÷N：P=TNH+R：S=9θH÷π：W=E+（P+R）NS
G=1： X =C+H÷6×（cosE+cosW+4×∑（cos（E+（（G+θ.5）HT+2R）（G+θ.5）S），G，θ，（N－1））+2∑（cos（E+（THG+2R）GS），G，1，（N－1）））+Icos(W+F)：Y =D+H÷6×（sinE+sinW+4×∑（sin（E+（（G+θ.5）HT+2R）（G+θ.5）S，G，θ，（N－1））+2×∑（sin（E+（THG+2R）GS，G，1,（N－1）））+Isin(W+F)
三、使用说明：
QD—起点里程；
ZD—终点里程；
1/Rθ、1/RN—起、终点曲率（左负右正）
Xθ、Yθ—起点坐标；
Fθ—起点方位角；
N—可取4～12，视线型而定，亦可改为变量；
ANG—线外左右测点连线与路线方向斜交右角；
X、Y—待求点中桩坐标
XI、YI—计算点中边桩坐标。
FW—切线方位角
K= —正算时为计算点里程；反算时为测点对应中桩里程
DP—正算时为支距（左负右正）；反算时为测点对应于中线某一角度ANG的支距（若ANG=90则为垂支距，左负右正）。