ST_SetCompFControl (Statement) [Version 1.9 or later]


Enables the compliance control function (exclusively designed for 6-axis robots).


ST_SetCompFControl


Enables the compliance control function, just like the ST_SetCompControl. Note that this command will not execute the gravity offset compensation.



  • If this command is executed when the gravity offset is disabled and the current limiter is disabled, then an error "60F5 Cannot execute compliance control" will occur.
  • Executing this command when the motors are off will not enable the compliance control. Under the compliance control, turning off the will disable the compliance control.
  • Execute this command in a TAKEARMed task has obtained arm semaphore. If this command is executed without arm semaphore obtained, Error "21F7 Cannot take arm semaphore" will result.
  • Execute this command when the robot is on halt. Executing this command in a pass motion will cause an end motion. If executing this command in a pass motion causes Error "600B Robot is running," then stop the robot with a Delay command and then execute this command.
  • Set the payload exactly. If the setting and actual payload differ, the robot arm may fall down in the direction of gravity. To prevent such a fall, execute the ST_SetGrvOffset.


ST_SetGrvOffset
'Calculate the gravity offset compensation
'value.
ST_SetFrcCoord 1
'Set the compliance control coordinate system.
ST_SetFrcLimit 100, 0, 100, 100, 100, 100
'Set the compliance rate
ST_SetCompFControl
'Enable the compliance control


Top