各位大侠,能帮我解决一下这个问题吗?
4 o# q+ c ?$ W3 O1,一台4轴直角坐标机器人,通过示教器示教得到空间中A,B,C , D.点.# _0 g/ J7 g. e/ z9 n3 f2 M) i5 A
控制要求如下:直角坐标机器人按照A,B,C,D顺序对示教点进行再现。* Q) l) i' O p7 X
本人写了二套程序效果不是很理想,想请各位指点指点!
5 ^/ |9 q& \) n t# |& l( [# Q mode:+ y* V# D- D8 Z
IF READ_OP(202)=1 THEN& r! Y* u2 i& f( }
BASE(2,1,0,3)
5 t+ `5 {1 L# k3 g" r& G7 w- k MERGE AXIS(2)=ON8 k* K9 b; D% Q1 ]3 P
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标4 t* @- i3 A4 E: b3 L) Y
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标0 n$ P1 p% O6 x4 D
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标* s: `/ O" |. k3 n
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标1 f9 b+ }8 z' {3 E& ?
MERGE AXIS(2)=OFF E/ q4 K; W! ^
ENDIF! [' f& {% [3 [- C
GOTO mode- s7 |9 I. p! E3 m
此程序在运行过程中的抖动,本人想是不是电机的旋转方向改变后引起的2 C# w& s+ C' e1 k3 j' E
电机抖动
- j, G' E6 g2 C& |; n mode1:7 M/ G. r, {( b% k$ q8 D. o# t
IF READ_OP(202)=1 THEN# W* v8 n5 [4 ?0 b0 z
BASE(2,1,0,3)
9 g, U, X% f$ Y! i9 u# s MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标' X: W! R8 J2 q9 A0 d
WAIT IDLE
0 e4 Q+ X# s' V- \# i MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标- b. z9 I" M5 k1 ^7 t- k7 t/ v- g
WAIT IDLE
' E' G& p" B" b2 O. B# g MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标
5 a5 w; Q' d7 g- k7 c& | WAIT IDLE# ^* H& I( | G" u0 ?
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标
4 P+ d3 f4 z# O. o. c WAIT IDLE
) u9 C& ~- D- j/ HENDIF# E- a6 d& w/ A' A5 p
GOTO mode 1
3 p$ b5 ?8 h1 o5 }# C; f此程序在运行过程中不抖动,但运行不平滑 。想请各位指点指点! " J' G1 P* A! I; J6 T/ V8 W
问题能得到解决,本人定有重谢 !联系电话:13782704927,杨
8 D, Z! W1 M- I7 h0 F- Z- q |