坐標計算源程序

1、一、 坐標計算源程序1.主程序(TYQXjs)"1.SZ => XY"："2.XY => SZ"：N：U"X0"：V"Y0"：O"S0"：G"F0"：H"LS"：P"R0"：R"RN"：Q：C=1÷P：D=(P-R)÷(2HPR)：E=180÷：N=1=>Goto 1：>Go to 2Lbl 1

2、：SZ：SZ：W=Abs(S-O)：Prog "SUB1"：X"XS"=XY"YS"=YGoto 1Lbl 2：XY：XY：I=X：J=Y：Prog "SUB2"：S"S"=O+WZ"Z"=ZGoto 22. 正算子程序(SUB1)A=0.1739274226：B=0.3260725774：K=0.0694318442：L=0.3300094782：F=1-L：M=1-K：X=U+W(Acos(G+QEKW(C+KW

3、D)+Bcos(G+QELW(C+LWD)+Bcos(G+QEFW(C+FWD)+Acos(G+QEMW(C+MWD)：Y=V+W(Asin(G+QEKW(C+KWD)+Bsin(G+QELW(C+LWD)+Bsin(G+QEFW(C+FWD)+Asin(G+QEMW(C+MWD)：F=G+QEW(C+WD)+90：X=X+ZcosF：Y=Y+ZsinF3. 反算子程序(SUB2)T=G-90：W=Abs(Y-V)cosT-(X-U)sinT)：Z=0：Lbl 0：Prog "SUB1"：L=T+QEW(C+WD)：Z=(J-Y)cosL-(I

4、-X)sinL：AbsZ<1E-6=>Goto1：>W=W+Z：Goto 0Lbl 1：Z=0：Prog "SUB1"：Z=(J-Y)÷sinF二、使用說明1、規(guī)定       (1) 以道路中線的前進方向（即里程增大的方向）區(qū)分左右；當線元往左偏時，Q=-1；當線元往右偏時，Q=1；當線元為直線時，Q=0。        (2) 當所求點位于中線時

5、，Z=0；當位于中線左鍘時，Z取負值；當位于中線中線右側時，Z取正值。        (3) 當線元為直線時，其起點、止點的曲率半徑為無窮大，以10的45次代替。        (4) 當線元為圓曲線時，無論其起點、止點與什么線元相接，其曲率半徑均等于圓弧的半徑。        (5) 當線元為完整緩和曲線時，起點與直線相接時，

6、曲率半徑為無窮大，以10的45次代替；與圓曲線相接時，曲率半徑等于圓曲線的半徑。止點與直線相接時，曲率半徑為無窮大，以10的45次代替；與圓曲線相接時，曲率半徑等于圓曲線的半徑。         (6) 當線元為非完整緩和曲線時，起點與直線相接時，曲率半徑等于設計規(guī)定的值；與圓曲線相 接時，曲率半徑等于圓曲線的半徑。止點與直線相接時，曲率半徑等于設計規(guī)定的值；與圓曲線相接時，曲率半徑等于圓曲線的半徑。2、輸入與顯示說明      

7、60;輸入部分：      1. SZ => XY      2. XY = > SZ       N ?  選擇計算方式，輸入1表示進行由里程、邊距計算坐標 ；輸入2表示由坐標反算里程和邊距。     X0 ？線元起點的X坐標

8、      Y0 ？線元起點的Y坐標      S0 ？線元起點里程     F0 ？線元起點切線方位角     LS ？線元長度     R0 ？線元起點曲率半徑     RN  ？線元止點曲率半徑 

9、0;   Q ？  線 元左右偏標志(左偏Q=-1，右偏Q=1，直線段Q=0)     S ？ 正算時所求點的里程     Z ？正算時所求點距中線的邊距(左側取負，值右側取正值，在中線上取零)     X ？反算時所求點的X坐標     Y ？反算時所求點的Y坐標 &

10、#160;   顯示部分：     XS=×××    正算時，計算得出的所求點的X坐標     YS=×××    正算時，計算得出的所求點的Y坐標     S=×××     反算時，計算得出的所求點的里程

11、     Z=×××     反算時，計算得出的所求點的邊距四、算例    某匝道的由五段線元（直線+完整緩和曲線+圓曲線+非完整緩和曲線+直線）組成，各段線元的要素（起點里程S0、起點坐標X0 Y0、起點切線方位角F0、線元長度LS、起點曲率半徑R0、止點曲率半徑RN、線 元左右偏標志Q）如下：S0   X0     Y0   

12、0;   F0      LS R0  RN    Q500.000    19942.837    28343.561     125 16 31.00    269.256   1E45 1E45  0769.256   &#

13、160;19787.340    28563.378     125 16 31.00   37.492     1E45 221.75   -1806.748    19766.566    28594.574     120 25 54

14、.07  112.779   221.75  221.75   -1919.527    19736.072    28701.893     91 17 30.63  80.285   221.75 9579.228  -1999.812    1

15、9744.038    28781.659     80 40 50.00   100.000     1E45  1E45   01、正算          （注意：略去計算方式及線元要素輸入，請自行根據(jù)所求點所在的線元輸入線元要素）   

16、0;        S=700  Z=-5    計算得  XS=19831.41785   YS=28509.72590            S=700  Z=0     計算得  XS=1982

17、7.33592   YS=28506.83837            S=700  Z= 5    計算得  XS=19823.25398   YS=28503.95084            S=780&

18、#160; Z=-5    計算得  XS=19785.25749   YS=28575.02270            S=780  Z=0     計算得  XS=19781.15561   YS=28572.16358 S=780  

19、;Z= 5    計算得  XS=19777.05373   YS=28569.30446                       S=870  Z=-5    計算得  XS=1974

20、7.53609   YS=28654.13091            S=870  Z=0     計算得  XS=19742.68648   YS=28652.91379            S=870&

21、#160; Z= 5    計算得  XS=19737.83688   YS=28651.69668                   S=940  Z=-5.123   計算得  XS=19741 . 59118&#

22、160; YS=28722.05802            S=940  Z=0        計算得  XS=19736.47687   YS=28722.35642            S=9

23、40  Z= 3.009    計算得  XS=19733.47298   YS=28722.53168                   2、 反算  X=19831.418   Y=28509.726  

24、 計算得  S=699.9999974  Z= -5 .00018164  X=19827.336   Y=28506.838   計算得  S=699.9996493  Z= 0.000145136  X=19823.25398   Y=28503.95084 計算得  S=699.9999985  Z=&

25、#160;5.000003137  X=19785.25749   Y=28575.02270計算得  S=780.0000035  Z= -5 .000001663  X=19781.15561   Y=28572.16358 計算得  S=780.0000025  Z=- 0.000002979 X=19777.05373   Y=28569.

26、30446  計算得  S=780.0000016  Z= 4.99999578  X=19747.536   Y=28654.131計算得  S=870.0001137  Z= -4.99941049  X=19742.686   Y=28652.914  計算得  S=870.0003175  Z=- 0.00041814  X=9737.837&#