|
各位大俠,能幫我解決一下這個(gè)問題嗎?5 O# ~. ]# k1 _# b u6 @2 r1 z
1,一臺(tái)4軸直角坐標(biāo)機(jī)器人,通過示教器示教得到空間中A,B,C , D.點(diǎn).
5 K7 f2 \: ~3 Q. i8 z K控制要求如下:直角坐標(biāo)機(jī)器人按照A,B,C,D順序?qū)κ窘厅c(diǎn)進(jìn)行再現(xiàn)。8 @& ]8 V) P" J
本人寫了二套程序效果不是很理想,想請(qǐng)各位指點(diǎn)指點(diǎn)!
1 T: D$ J+ v6 U mode:
6 I' Z, h3 X' P5 Z' G; P9 o$ RIF READ_OP(202)=1 THEN# S; M! v, ~( l, J
BASE(2,1,0,3)$ K+ m% [. N% W: k; M
MERGE AXIS(2)=ON0 Q ?- r# n2 T% P3 Z3 \1 y
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點(diǎn)坐標(biāo)' n5 ^" t! r/ |; O
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點(diǎn)坐標(biāo)
& i/ C R: N9 [5 x6 K MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點(diǎn)坐標(biāo)
1 S+ m% @: b0 Y MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點(diǎn)坐標(biāo)/ K9 a, A8 w& v, o( Y6 K
MERGE AXIS(2)=OFF
0 E8 [' x' }9 @, p) jENDIF3 y! c' J5 u$ z' U o; K1 o! \
GOTO mode) {* s& H5 A* _$ T+ c3 x) q
此程序在運(yùn)行過程中的抖動(dòng),本人想是不是電機(jī)的旋轉(zhuǎn)方向改變后引起的3 \; A! J" S" @1 H5 k" q9 z
電機(jī)抖動(dòng)
, l% o4 t0 o. C) P8 m mode1:6 T# c! e; ~# q7 l8 A
IF READ_OP(202)=1 THEN+ N7 U2 _/ D( Q" c
BASE(2,1,0,3)
6 [, V) Z/ U X. _+ g5 c8 K MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點(diǎn)坐標(biāo)
9 a# v$ [7 l2 o/ q, X/ X4 d WAIT IDLE" U! |, ?9 R8 e0 G
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點(diǎn)坐標(biāo)
5 l5 z* ^3 _& b a& A% c$ B, | WAIT IDLE
/ H, g" \4 S, b& P4 P, U+ ?" H MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點(diǎn)坐標(biāo); s3 O F/ M" n, J0 \
WAIT IDLE: B$ k q( o9 a0 j$ b
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點(diǎn)坐標(biāo)
H2 _- ], a! L. I& g# w" t WAIT IDLE; r" |8 Q2 I9 u6 X: K2 r
ENDIF' t/ d5 a5 u5 \1 b+ H9 a
GOTO mode 1
8 U- a5 l# w* p( a8 b$ i8 j此程序在運(yùn)行過程中不抖動(dòng),但運(yùn)行不平滑 。想請(qǐng)各位指點(diǎn)指點(diǎn)!
( N; H# G1 a! k% q8 g問題能得到解決,本人定有重謝 !聯(lián)系電話:13782704927,楊 ) N; M/ v7 i4 P" } T( G
|
|