曲線任意坐標正反算5800p好用

1、曲線任意坐標正反算5800p三TYQXJS (主程序名)Lbl 0:4 f Dimz:Cls1.SZ f XY2.XY f SZ?f N:ClsXO?U: YO?V: SO? O:FO?G: LS?H: RO?P:RN?R:?Q1 -Pf C: (P-R) *(2HPR) f D : 180 nEN=2=Goto 2LbI 1:Cls:?S:S=0=Goto 0?Z:Abs(S- O)f WProgSUB1:ClsXS=:X 丄YS=:Y 丄FS=:F-90? DMS 丄Goto 1LbI 2:Cls:?XX=0=Goto 0?Y:Xf I:Yf JProgSUB2: O+W f S:ClsS

2、=:S 丄Z=:Z 丄Goto 2注:紅色部可以不要，亦可以要，它的作用是將S或 X輸入0時，程序會重新由頭開 始運行，（即是可以計算下段線元）SUB1 （子程序名）0.1739274226 f A:0.3260725774 f B0.0694318442 f K:0.330009482 f L1-L f F:1-K f MG+QEKW(C+KWD)f Z1G+QELW(C+LWD)f Z2G+QEFW(C+FWD)f Z3G+QEMW(C+MWD) f Z4A Xcos(Z1) f XX+Bcos(Z2) f XX+Bcos(Z3) f XX+Acos(Z4) f XU+WX f XAsin

3、(Z1) f YY+Bsin(Z2) f YY+Bsin(Z3) f YY+Asi n(Z4) f YV+WY f YG+QEW(C+WD)+90f FX+Zcos(F) f XY+Zsin(F) f YSUB2 (子程序名)G-90 f T(Y-V)cos(T)-(X-U)s in (T)f WAbs(W) f W:0 f ZLbl 4:ProgSUB1T+QEW(C+WD) f L(J-Y)cos(L)-(I-X)si n(L) f ZIf Abs(Z) v 1E-6:Then 0 f Z :ProgSUB1:(J-Y) *sin(F) f ZElse W+Z f W:Goto 4:lfE

4、nd數(shù)據(jù)庫If SW終點樁號：Then1 f N: f U:起點X坐標f A:起點Y坐標f B:起點切線方位角f C:起點曲率f D:終點曲率f E: Goto 0:If End換行| ij I . |o oooooooooo000000000000000000000000000000N個Lb1 0: Return 換行曲率左偏為負右偏為正Return為程序命令線元要素可以用常規(guī)程序計算如有多條路數(shù)據(jù)庫另建如Z2 Z3 。等等需要使用時把主程序Z1改為Z2依次類推NO？為要求點里程注:1E-6即是10的負6次方，亦即是等於 0.000001輸入時按 SHIFT-log-(-)-6亦可直接將 I

5、f Abs(Z) v 1E-6 寫成 If Abs(Z) v 0.000001注意:本程序是根據(jù)yhhf編寫的4800P改寫而成，以下是源程序及算例大家有問題亦可在以下網(wǎng)址查看及向yshf發(fā)問 ng.n et/celia ng/article_view.asp?id=380&author=yshf曲線任意里程中邊樁坐標正反算 （CASIO fx-4800P計算器）程序一、程序功能本程序由一個主程序（TYQXJS）和兩個子程一一正算子程序 （SUB1）、反算子程序（SUB2）序構(gòu)成，可以根據(jù)曲線段直線、圓曲線、緩和曲線（完整或非完整型） 的線元要素（起點坐標、起點里程、起點切線方位角、線元長度、

6、起點曲率半徑、止點曲率半徑）及里程邊距或坐標，對該曲線段范圍內(nèi)任意里程中邊樁坐標進行正反算。另外也可以將本程序中核心算法部分的兩個子程序移植到其它相關(guān)的程序中，用于對曲線任意里程中邊樁坐標進行正反算。本程序也可以在CASIO fx-4500P計算器及CASIO fx-4850P計算器上運行。特別申明：（1）.適用于弧長小于2倍半徑的各種線元坐標正反算，精度優(yōu)于 1mm ；（2）.在引用該核心計算部分時，請注明來源。二、源程序1. 主程序（TYQXJS）1.SZ = XY : 2.XY = SZ : N : UX0 : VY0 : OS0 : GF0 : HLS:PR0 : RRN : Q :

7、C=1 訐：D=（P-R） *（2HPR） : E=180 *n:N=1=Goto 1 :工Goto2 A Lbl 1 : SZ: SZ: W=Abs(S- O): Prog SUB1 : XXS=X 丄YYS=Y 丄FFS=F-90 丄Goto 1 Lbl 2 : XY: XY: I=X : J=Y : Prog SUB2 : SS= O+W 丄ZZ=Z 丄Goto 22.正算子程序(SUB1)A=0.1739274226: B=0.3260725774: K=0.0694318442: L=0.3300094782F=1-L :M=1-K : X=U+W(Acos(G+QEKW(C+KWD

8、)+Bcos(G+QELW(C+LWD)+Bco s(G+QEFW(C+FWD)+Acos(G+QEMW(C+MWD) : Y=V+W(Asi n(G+QEKW(C+KWD)+Bsi n(G+QELW(C+LWD)+Bsi n(G+QEFW(C+FWD)+Asi n( 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-(l-X)s

9、inL : AbsZGoto1:工W=W+Z : Goto 0 ALbl 1 : Z=0 : Prog SUB1 : Z=(J-Y) FinF三、使用說明1、規(guī)定(1) 以道路中線的前進方向(即里程增大的方向)區(qū)分左右；當線元往左偏時，Q=-1 ;當線元往右偏時，Q=1 ;當線元為直線時，Q=0。(2) 當所求點位于中線時，Z=0 ;當位于中線左鍘時，Z取負值；當位于中 線中線右側(cè)時，Z取正值。(3) 當線元為直線時，其起點、止點的曲率半徑為無窮大，以10的45次代替。(4) 當線元為圓曲線時，無論其起點、止點與什么線元相接，其曲率半徑均等于圓弧的半徑。(5) 當線元為完整緩和曲線時，起點與直

10、線相接時，曲率半徑為無窮大，以10 的 45次代替；與圓曲線相接時，曲率半徑等于圓曲線的半徑。止點與直線相接時，曲 率半徑為無窮大，以10的45次代替；與圓曲線相接時，曲率半徑等于圓曲線的半徑。(6) 當線元為非完整緩和曲線時，起點與直線相接時，曲率半徑等于設(shè)計規(guī)定的值；與圓曲線相接時，曲率半徑等于圓曲線的半徑。止點與直線相接時，曲率半于設(shè)計規(guī)定的值；與圓曲線相接時，曲率半徑等于圓曲線的半徑。2、輸入與顯示說明輸入部分：1. SZ = XY2. XY = SZN ?選擇計算方式，輸入1表示進行由里程、邊距計算坐標；輸入2表示由 坐標反算里程和邊距。X0 ?線元起點的X坐標Y0 ?線元起點的Y坐

11、標SO ?線元起點里程F0 ?線元起點切線方位角LS ?線元長度R0 ?線元起點曲率半徑RN ?線元止點曲率半徑Q ?線元左右偏標志(左偏Q=-1，右偏Q=1，直線段Q=0)S ?正算時所求點的里程Z ?正算時所求點距中線的邊距（左側(cè)取負，值右側(cè)取正值，在中線上取零 ）X ?反算時所求點的X坐標Y ?反算時所求點的Y坐標顯示部分：XS= xx（正算時，計算得出的所求點的X坐標YS= xx（正算時，計算得出的所求點的Y坐標FS= xxx:正算時，所求點對應(yīng)的中線點的切線方位角S= xxx反算時，計算得出的所求點的里程Z= xxx反算時，計算得出的所求點的邊距四、算例某匝道的由五段線元（直線+完整

12、緩和曲線+圓曲線+非完整緩和曲線+直線） 組成，各段線元的要素（起點里程 SO、起點坐標X0 Y0、起點切線方位角F0、線 元長度LS、起點曲率半徑 R0、止點曲率半徑 RN、線 元左右偏標志Q）如下：SO X0Y0F0LS R0 RNQ500.00019942.83728343.561125 16 31.00269.2561E451E450769.25619787.34028563.378125 16 31.0037.4921E45221.75-1806.74819766.56628594.5741202554.07112.779221.75221.75-1919.52719736.0722

13、8701.893911730.6380.285221.759579.228-1999.81219744.03828781.659804050.00100.0001E451E4501、正算（注意：略去計算方式及線元要素輸入，請自行根據(jù)所求點所在的線元輸入線元要素）S=700Z=-5計算得XS=19831.41785YS=28509.72590S=700Z=0計算得XS=19827.33592YS=28506.83837S=700Z=5計算得XS=19823.25398YS=28503.95084S=780Z=-5計算得XS=19785.25749YS=28575.02270S=780Z=0計算得

14、XS=19781.15561YS=28572.16358S=780Z=5計算得XS=19777.05373YS=28569.30446S=870Z=-5計算得XS=19747.53609YS=28654.13091S=870Z=0計算得XS=19742.68648YS=28652.91379S=870Z=5計算得XS=19737.83688YS=28651.69668S=940 Z=-5.123計算得 XS=19741.59118 YS=28722.05802S=940Z=0計算得XS=19736.47687YS=28722.35642S=940Z=3.009計算得XS=19733.47298

15、YS=28722.531682、反算X=19831.418Y=28509.726計算得 S=699.9999974 Z=-5 .00018164X=19827.336Y=28506.838計算得 S=699.9996493 Z=0.000145136X=19823.25398Y=28503.95084計算得1 S=699.9999985 Z=5.000003137X=19785.25749Y=28575.02270計算得S=780.0000035 Z=-5 .000001663X=19781.15561Y=28572.16358計算得S=780.0000025 Z=-0000002979X=19777.05373Y=28569.30446計算得S=780.0000016 Z=4.99999578X=19747.536Y=28654.131計算得 S=870.0001137 Z=-4.99941049X=19742.686Y=28652.914計算得 S=870.0003