各位大俠,能幫我解決一下這個問題嗎?
8 j8 a9 v+ I. @: D# S( m# L1,一臺4軸直角坐標機器人,通過示教器示教得到空間中A,B,C , D.點.
) r) q+ [/ L4 e3 d控制要求如下:直角坐標機器人按照A,B,C,D順序對示教點進行再現。
" ~7 c( B1 X0 B7 R3 I本人寫了二套程序效果不是很理想,想請各位指點指點!
: j: I' ~) A- x; u mode:% ^& p% `- [( j% X8 A
IF READ_OP(202)=1 THEN
( @+ {7 k! a& [/ n4 @* R BASE(2,1,0,3)( K2 O7 Q" W- u5 E3 `. ~6 g
MERGE AXIS(2)=ON, z, O% j4 f' O2 q$ f% ^; I0 c
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標' G8 x& x7 Y: p, `) T
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標
3 l6 l8 J* o! V! S MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標+ E: I c9 P2 r* W8 N2 W3 H: |/ ~
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標
( A* i- }# @. {MERGE AXIS(2)=OFF V1 `4 _% S& ^1 G- W$ Y) l! l( n( |
ENDIF
|- a2 h. L3 e/ q5 T* }7 I2 AGOTO mode- q4 A3 ?3 n+ P8 S2 j) i7 w% `
此程序在運行過程中的抖動,本人想是不是電機的旋轉方向改變后引起的
# ?. H9 @3 P; J; v# j8 E5 e2 p電機抖動
# b/ n/ l: v1 `/ X mode1:. ?; q, G) v& R# q( x
IF READ_OP(202)=1 THEN: U) @4 J" g5 H' L4 n9 f
BASE(2,1,0,3)
4 \/ x, o+ B1 J MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標! D3 o; M/ W6 U4 q; g. i' o- n
WAIT IDLE
( D5 v) ~; {" P' P: M MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標9 N' Y% T B$ |+ t6 E3 S' P* h* w
WAIT IDLE( M( `$ L2 M7 v& `! R1 S, F1 ~
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標
, A1 A$ C" n9 _4 B WAIT IDLE. l9 w+ ?, H5 m8 \4 D# N1 D C
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標# d" I# H4 t( u% ]
WAIT IDLE
8 x7 b0 k9 P7 p1 W. a. I$ a5 V* rENDIF6 y, I2 i6 \) }/ W4 D$ t
GOTO mode 1 / E7 p) `0 f1 Y' o
此程序在運行過程中不抖動,但運行不平滑 。想請各位指點指點! ! p; t" b" H) D
問題能得到解決,本人定有重謝 !聯系電話:13782704927,楊 9 d. q, \/ q# z1 A+ ~# b- D, x# h
|