Hello,
I need some help please with collision detection.
I have an application to manipulate a part. If you take a look at images you will understand my problem.
The pin should enter inside the "channel"(I don'tknow the word in english).
This is the motion to that position, is around 1,5 cm long.
;FOLD LIN CH_120 Vel=0.05 m/s H Tool[12]:Gripper_CH_Full Base[0] CD;%{PE}%R 8.3.32,%MKUKATPBASIS,%CMOVE,%VLIN,%P 1:LIN, 2:CH_120, 3:, 5:0.05, 7:H
$BWDSTART=FALSE
LDAT_ACT=LH
FDAT_ACT=FCH_120
BAS(#CP_PARAMS,0.05)
TQM_FIFO_READ(TM3)
TRIGGER WHEN DISTANCE=0 DELAY=0 DO iTQM_TRIGGERID=3
TRIGGER WHEN DISTANCE=0 DELAY=0 DO TQM_START_MON(TM3) PRIO = -1
TRIGGER WHEN DISTANCE=1 DELAY=0 DO TQM_SWAP_VALUES(TM3) PRIO = -1
LIN XCH_120
;ENDFOLD
DECL TQM_TQDAT_T TM3={T11 7,T12 17,T13 11,T14 26,T15 55,T16 26,T21 2872,T22 4392,T23 1726,T24 1241,T25 2214,T26 2656,K1 303,K2 301,K3 305,K4 305,K5 319,K6 314,O1 5,O2 5,ID 3,OVM 30,TMF 1.00000}
Using the KCP ,I modified the torgue and impact at 5.
The controller doesn't react with collision but after 60 sec I got the message "Current overload after 60sec (A5). (HoldingCurrent)". $torg_diff[5]=75. I tried in T2, 30% velocity.
I want to detect the rotation of pin with collision detection and to stop the process.
THank you!