-174-
(
→
Continuation of (1) Part assembly work (force control))
Description
1
)
With force control, the robot is set to push with a force of 0.0 N in the X- and Y-directions, and
5.0 N in the Z-direction. Furthermore, if the reaction force in the Z-direction is less than 4 N,
the robot moves at a speed of 10 mm/s in speed priority mode.
2
)
Work complete conditions are defined for Mo trigger 1 with the Def MoTrg command. (In this
example, when Z ≤ 151 mm and Fzt > 4.8 N, it is judged that insertion work is complete.)
3
)
After moving to the assembly start position, by enabling Mo trigger 1 followed by force sense
control, insertion work is started automatically.
4
)
If insertion work is not completed within 5 seconds of work starting, a 9100 error is output and
insertion work is stopped.
5
)
If insertion work is completed successfully, M_MoTrg(1)=1 and interrupt processing (label: *XOK) is
performed.
22 M_Timer(1)=0
'Timer clear
23 *LBL1:If M_Timer(1) < 5000 Then Goto *LBL1
24 Fsc Off
'Force sense control is disabled.
25 Error 9100
'Error occurs if insertion work not complete within 5 seconds.
26 End
27 '*** <Work completed> ***
28 *XOK
'Insertion work complete interrupt processing
29 Act 1=0
30 SetMoTrg 0
31 Fsc Off
'Force sense control is disabled.
32 HOpen 1
33 P2=P_Fbc
'Feedback position acquisition
34 P2.Z=P2.Z+100
'Target position determined as po100 mm in
Z-direction from current position.
35 Mvs P2
36 End
Summary of Contents for MELFA BFP-A3614
Page 1: ...Mitsubishi Industrial Robot Robot Seminar Textbook Force Sensor Application BFP A3614 ...
Page 2: ......
Page 34: ... 23 2 F series a CR750 D controller ...
Page 35: ... 24 b CR751 D controller ...
Page 36: ... 25 c CR750 Q CR751 Q controller CPU module ...
Page 75: ... 64 MEMO Please use this page for your memo ...
Page 95: ... 84 MEMO Please use this page for your memo ...
Page 103: ... 92 MEMO Please use this page for your memo ...
Page 111: ... 100 MEMO Please use this page for your memo ...
Page 119: ... 108 MEMO Please use this page for your memo ...
Page 123: ... 112 MEMO Please use this page for your memo ...
Page 129: ... 118 MEMO Please use this page for your memo ...
Page 133: ... 122 MEMO Please use this page for your memo ...
Page 137: ... 126 MEMO Please use this page for your memo ...
Page 143: ... 132 MEMO Please use this page for your memo ...
Page 149: ... 138 MEMO Please use this page for your memo ...
Page 153: ... 142 MEMO Please use this page for your memo ...
Page 159: ... 148 MEMO Please use this page for your memo ...
Page 171: ... 160 MEMO Please use this page for your memo ...
Page 183: ... 172 MEMO Please use this page for your memo ...
Page 191: ... 180 MEMO Please use this page for your memo ...
Page 211: ......