Industrial robot collision detection method

Abstract

The invention discloses an industrial robot collision detection method. The method comprises the steps that the collision detection method based on the moment difference is adopted, the prediction torque of each joint is predicted in real time in the operation process of a robot, and the difference value between the prediction torque and the actual noise reduction moment is calculated. According to the method, the hysteresis time of the actual noise reduction moment of each joint relative to the predicted moment is accurately calculated by applying a method for calculating correlation values of the predicted torque and the actual noise reduction moment, so that the predication moment of each joint is subjected to delay treatment, so that the error of the moment difference of the predication moment and the actual noise reduction moment is smaller, the collision threshold value is reduced, and the sensitivity of collision detection is improved.

Description

technical field [0001] The invention relates to a detection method for an industrial robot, in particular to a method for collision detection of an industrial robot. Background technique [0002] Industrial robots may collide with external objects or people for some reason during operation, resulting in damage to the body and injury to personnel. Therefore, collision detection is very important for the safety of robots. Common collision detection can be mainly divided into two categories, collision detection based on sensors such as force sense and smart skin, which can improve detection sensitivity, but greatly increases the cost; the other is sensorless collision based on dynamic model Detection, this method can reduce the cost, but the sensitivity of collision detection is not high due to modeling errors and other reasons. [0003] Chinese patent CN102426391A discloses a method to measure whether a robot collides during operation by calculating a collision scalar. Two v...

AI Technical Summary

Problems solved by technology

This invention delays the predicted joint torque by N cycles, but it does not explain what standards and methods are used to calculate the delay cycle. It is only based on experimental analysis, which is very general and inaccurate. At the same time, the robot has different postures under different working conditions. Under load, the response of the servo system is different, so the predicted torque delay time of each joint is not necessarily the same

Inaccurate delay processing will cause errors in torque difference, increase the collision detection threshold, reduce the sensitivity of collision detection, and easily cause false alarms

Images