本人基于FANUC搖籃式五軸，編了一段五軸坐標計算的程序，由于沒有機床，全靠個人理解

傷情于劍

% F8 j% I- C& }- l& l6 O
6 R" z) q) ?' Z: h) H我也不知道對不對，希望各位能指點一下

/ I, p+ Z8 X* E
O9013(Q?R?A?C?X?Y?Z?)

+ ]; _% l/ X, A: c% D6 {# }#4=#7001+#24-#500(P1X+U-X0)
6 n- O; |% B! T) I+ ~& O0 N
#5=#7002+#25-#501(P1Y+V-Y0)
/ S+ M! H* @& d# H1 G- x
4 Y% Y+ `4 E4 ?8 c#6=#7003+#26-#502(P1Z+W-Z0)
  w+ u- c: _* n; z
9 P$ F5 x  s7 ^#7=#7004-#503(P1A-A0)
! S" W0 u, i9 e) l
#8=SQRT[#5*#5+#6*#6]

#9=ATAN[#6]/[#5]+#7
' j" P; w# j2 U9 K+ J8 t: o2 O
#25=#8*COS[#9]

' a: [2 m: X' e7 V#26=#8*SIN[#9]
2 i* @7 `! }8 z% S
3 B# T5 u8 H* V% t8 [. Z( i! u, z#8=SQRT[#4*#4+#25*#25]
$ y/ y8 q2 L1 N/ O
3 v( @' F& J* Y#9=ATAN[#25]/[#4]+#3
* O' L7 m) Y% }  s  ~) S' P
) c$ |0 S& o7 M#24=#500+#8*COS[#9]

1 e! h' O, h5 s  \: v- d2 t' B#25=#8*SIN[#9]

1 d8 J/ u& E! k$ m#8=SQRT[#26*#26+#25*#25]

3 D& v( w1 u( N( i) G. l#9=ATAN[#26]/[#25]+[#1-#7]
/ M. B  i6 T* k6 j( d  H
#25=#501+#8*COS[#9]

#26=#502+#8*SIN[#9]
" |# r) B7 Y1 c0 Z! m) z* R2 D/ _
G90G10L#17P#18X#24Y#25Z#26A[#7004+#1]C[#7005+#3]
  q3 n4 C" q1 }- ~/ R
" ]- L4 y6 \5 a, Y# qM99
& O, i# f* M4 ~# a" G
4 H3 y* `" x  G8 P: Y%
, w7 d0 x- O9 ]9 H" s

zhumao6011

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