Table of Contents
Advertisement
4MELFA-BASIC IV
Cmp Tool (Composition Tool)
[Function]
Start the soft control mode (compliance mode) of the specified axis in the Tool coordinates system.
Note) The available robot types for this instruction are limited. Refer to "[Available robot type]".
[Format]
Cmp[]Tool, <Axis designation>
[Terminology]
<Axis designation> Designate axis to move softly with a bit pattern.
[Reference Program]
1 Mov P1
2 CmpG 0.5, 0.5, 1.0, 0.5, 0.5, , ,
3 Cmp Tool, &B011011
4 Mvs P2
5 M_Out(10)=1
6 Dly 1.0
7 HOpen 1
8 Mvs, -100
9 Cmp Off
[Explanation]
(1) The robot can be moved softly with the tool coordinate system. For the tool coordinate system, please
refer to
Page 364, "5.6 Standard Tool
(2) For example, when inserting a pin in the tool coordinate Z axis direction, if the X, Y, A and B axes are set
to soft operation, the pin can be inserted smoothly.
(3) The degree of softness can be designated with the CmpG command.
(4) The soft state is maintained even after the robot program execution is stopped. To cancel the soft status,
execute the "Cmp Off" command or turn Off the power.
(5) When pressing in the soft state, the robot cannot move to positions that exceed the operation limit of each
joint axis.
(6) The deviation of the command position and actual position can be read with M_CmpDst. The success/fail-
ure of pin insertion can be checked using this variable.
(7) If the amount of difference between the original target position and the actual robot position becomes
greater than 200 mm by pushing the hand, etc., the robot will not move any further and the operation shifts
to the next step of the program.
(8) It is not possible to use Cmp Jnt, POS, and Tool at the same time. In other words, an error occurs if the
Cmp Pos or Cmp Tool instruction is executed while the Cmp Jnt instruction is being performed. Cancel the
Cmp Jnt instruction once using the Cmp Off instruction to execute these instructions.
(9) If the servo turns from Off to On while this command is functioning, the robot position could change.
(10) It is possible to perform jog operations while the robot is in compliance mode. However, the setting of the
compliance mode cannot be canceled by the T/B; in order to do so, execute this instruction in a program
or execute it directly via the program edit screen of the T/B.
(11) To change the axis specification, cancel the compliance mode with the Cmp Off instruction first, and then
execute the Cmp Tool instruction again.
(12) For vertical 5-axis robots (such as the RV-3SDJ), only the X and Z axes can be used for axis specifica-
tion.
(13) If the robot is operated near a singular point, an alarm may be generated or control may be disabled. Do
not operate the robot near a singular point. If this situation occurs, cancel the compliance mode by exe-
4-167 Detailed explanation of command words
1 : Enable, 0 : Disable &B00000000
This corresponds to axis L2L1CBAZYX
' Moves to in front of the part insertion position.
' Set softness.
' The X, Y, A, and B axes are put in the state where they are con-
trolled in a pliable manner.
' Moves to the part insertion position.
' Instructs to close the chuck for positioning.
' Waits for the completion of chuck closing.(1 sec.)
' Open the hand.
' Retreats 100 mm in the Z direction of the Tool coordinate sys-
tem.
' Return to normal state.
Coordinates".
Advertisement
Table of Contents
