求fx5800计算器 点到直线距离的程序!知道的麻烦说一下

这是坐标反算偏距（左+，右-）的程序，我用的是海伦算法，缺点：P点为线上任意点时，

本程序“PIAN

JU“（偏距）以后代码失效，如有不同算法者，与我联系，共同研究。

“X1”?→X↙

“Y1”?→Y↙

“X2”?→A↙

“Y2”?→B↙

Pol((A-X),(B-Y))↙

If

J<0:

Then

J+360→J:

Else

J→J

:

IfEnd

↙

I◢

得出两点间距离

J►DMS◢

得出两点间方位角（度分秒）

”PIAN

JU:0”?

→V↙

要计算偏距，请按“0”，返回反算请按0以外任意数

If

A≠0:Then

Goto

A:

Else

Lbl

B

:

IfEnd↙

“PX”?→C↙

“PY”?→D↙

√((A-C)^2+(B-D)^2)→F↙

√((C-X)^2+(D-Y)^2)→G↙

(I+F+G)/2→S↙

√(S*(S-I)*(S-F)*(S-G))

→M↙

M/I*2→W↙

Cos-1((I^2+F^2-G^2)/(2I*F))→O↙

O►DMS↙

用反余弦算出夹角度分秒但不显示

I-W/(tan(O))

→T◢

得出直线到垂足的距离（加入正算得出垂足标）

(C-(X+(T*cos(J))))/cos(J-90)◢

得出点到直线垂直距离（（左+，右-））

Goto

B

"XA=”?X:”YA=”?Y:“FWJ=”?J:”K0=“?K 回车

Lbl 0 回车

"KP=“?L: ”BJ=“?M 回车

A＋(L－K)cos(J)+Mcos(J－90)→X 回车

B＋(L－K)sin(J)+Msin(J－90) →Y 回车

“XP=“:X◢

“YP=“:Y◢

Goto 0 回车

Xa、Ya ——直线上已知里程的坐标（X,Y）

FWJ ——直线方位角

K0——A点桩号（即里程）

K1——待算点桩号，即待算点在已知直线上距离点A的距离

BJ——待算点中桩距离，顺直线前进方向，左＋右－

---