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

傷情于劍

& Z4 y2 w; J4 x4 ^& ^5 v. T
我也不知道對不對，希望各位能指點一下

& b. t( l1 X( a3 Y1 d5 r) U
) G2 v( o. w0 w) y" GO9013(Q?R?A?C?X?Y?Z?)
/ R* U% |3 F- V
; Q& O& S" y- U9 W9 q#4=#7001+#24-#500(P1X+U-X0)

#5=#7002+#25-#501(P1Y+V-Y0)
2 |* V$ k0 ^5 r! g5 U2 A2 B' e
#6=#7003+#26-#502(P1Z+W-Z0)

  i& F9 i4 P) x8 |* y#7=#7004-#503(P1A-A0)
4 H8 W  v) _# `! j% L, Z) c! P
  \5 s( v6 Z* a( |#8=SQRT[#5*#5+#6*#6]
$ \1 t4 {% Y! w9 ?
#9=ATAN[#6]/[#5]+#7
4 c$ r/ `$ P  E' E1 D) `' Z
#25=#8*COS[#9]
: s  j/ f8 J  Y& F! ]9 G
8 M; s' ^( P4 o, S" F#26=#8*SIN[#9]

# h, d3 o* n3 K  w" |#8=SQRT[#4*#4+#25*#25]
8 P. O* ^6 M3 J, x" v: C
- c$ b/ E/ d+ \( ~+ V+ Y4 L#9=ATAN[#25]/[#4]+#3

$ _+ C$ d+ O! Z8 @#24=#500+#8*COS[#9]
% i3 P4 V0 W8 H/ U% f
#25=#8*SIN[#9]
- \: B: y4 K8 S6 s  I0 t7 n+ c! ]7 c
- A4 u# X" R' i; D#8=SQRT[#26*#26+#25*#25]

#9=ATAN[#26]/[#25]+[#1-#7]
) Q- f! g( e* K& i
#25=#501+#8*COS[#9]

#26=#502+#8*SIN[#9]

, W& E0 m* K% ~G90G10L#17P#18X#24Y#25Z#26A[#7004+#1]C[#7005+#3]
& T0 I; H8 R/ u4 @6 G' I6 ^9 |8 ?
' {) w& o, T7 J" M( SM99
% o: Y" ~  E4 b# d" w
  Z6 f- S6 R* ~; ?) H%

zhumao6011

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