Table of Contents
Advertisement
Point
If the impact detection function is enabled, the execution time (tact time) may become longer depending
on the program. In order to reduce influence on the tact time, use the impact detection function only for
operations that may cause interference, rather than enabling the function for the entire program.
*Adjustment of impact detection level
Adjust the detection level (sensitivity) at program operation according to the robot operation. As a reference,
an example of adjustment procedure is shown below. be sure to set the workpiece condition and hand con-
dition properly as well in order to estimate the torque accurately.
*Behavior when interference is detected
If an interference with peripheral devices or similar is detected during program operation, an error numbered
in the 1010's (the least significant digit is the axis number) is generated and the robot is stopped as the
servo is turned off. If the robot is in the NOERR mode, no error is generated, but the robot stops as the
servo is turned off (an error numbered in the 1010's will be recorded in the error history, however).
Table 5-22:Example of detection level adjustment procedure at program operation
Step
1
Add the COLLVL and ColChk instructions before and after operations for which the impact detection func-
tion is used.
2
Set the detection level low (the argument of the COLLVL instruction is set to a large value such as 300) in
order to prevent erroneous detection of interference.
3
Run the program and monitor the value of J_ColMxl in the target operation. Note that the value may fluctu-
ate; repeat the target operation several times and record the J_ColMxl value each time.
4
Obtain the maximum value for each joint axis from multiple J_ColMxl values and add some margin (e.g.,
20%) to the value. Then set this value as the argument of the COLLVL instruction.
5
Set the value obtained in step 4 to the COLLVL instruction and run the program to check that no erroneous
detection occurs at the operation for which the impact detection function is used. If an interference is erro-
neously detected, gradually increase the value of the argument of the COLLVL instruction to lower the
detection level until no erroneous detection occurs.
Point
When the operation speed is changed, it may become necessary to change the detection level. Operate
the robot at the actual operation speed and then adjust the detection level.
Point
If the impact detection function is used for multiple robots, it may become necessary to adjust the detec-
tion level for each robot even for the same operation, due to individual differences of robots due to differ-
ences in motor characteristics and usage environment. Note also that if there are several robot models,
the detection level must be adjusted for each robot.
Description
About the impact detection function 5-406
5Functions set with parameters
Advertisement
Table of Contents
