本人基于FANUC搖籃式五軸，編了一段五軸坐標(biāo)計(jì)算的程序，由于沒有機(jī)床，全靠個(gè)人理解

傷情于劍

' _& B. e. k! [" ~我也不知道對(duì)不對(duì)，希望各位能指點(diǎn)一下
! N  O, H; ^' _' I  T* Q4 c  ^/ e

( }# X6 i3 g1 I  z% QO9013(Q?R?A?C?X?Y?Z?)
4 k* Y" \' z1 R! X
& C9 ^2 O- F% J6 s. m#4=#7001+#24-#500(P1X+U-X0)

#5=#7002+#25-#501(P1Y+V-Y0)

#6=#7003+#26-#502(P1Z+W-Z0)
' N, r: q5 {$ [: D- v
) m) e/ c" O% n. v; \, M- G#7=#7004-#503(P1A-A0)

. O* E* f/ A+ ?#8=SQRT[#5*#5+#6*#6]
$ L. `9 h' [/ ?5 G* s- x7 f9 a3 I* \
#9=ATAN[#6]/[#5]+#7
/ K3 _1 q$ T2 I& b6 J5 u
#25=#8*COS[#9]
8 |7 T6 x0 {9 F7 U; A4 c. [2 c: {
#26=#8*SIN[#9]
% Q( ]6 D# G  E) F- Y
#8=SQRT[#4*#4+#25*#25]
; Y, Y! K' v' ~+ ]
* t$ h! j! V$ ?* o) A; R#9=ATAN[#25]/[#4]+#3
# ]5 n0 f! ^; G4 P
$ p( m$ R; O7 h- A' A( C5 [# w#24=#500+#8*COS[#9]

#25=#8*SIN[#9]
5 F2 c# q- y$ ~4 f" d; F# r% x
& s' R; t& R9 e#8=SQRT[#26*#26+#25*#25]

* m8 _) ^5 S+ U& a' s#9=ATAN[#26]/[#25]+[#1-#7]

#25=#501+#8*COS[#9]
9 ?8 ?8 G( M3 p) u- W* j  b
# A. B8 e2 F4 R#26=#502+#8*SIN[#9]

G90G10L#17P#18X#24Y#25Z#26A[#7004+#1]C[#7005+#3]
! n- `  h' ~5 s+ E  `1 {; l
; B5 _( ^& ~- U' y3 e+ S8 o# t: sM99
" ~# ~' q2 q+ t
%

zhumao6011

忍不住多看了兩眼樓主頭像