The dragging teaching method is easy to operate and has high teaching efficiency, which is more in line with modern flexible production. To realize the dragging teaching of industrial robots, it is necessary to accurately measure the external force and control the motion caused by the external force. In order to measure the external force exerted by the operator without torque sensor, an external force observer based on disturbance Kalman filter was designed. The observer takes the external joint torque as the disturbance term, and introduces generalized momentum to establish the state space equation of the robot system, and then uses the Kalman filter algorithm to obtain the optimal observed value of the external torque. Among them, in order to improve the estimation accuracy, the robot dynamic model was established by combining the rigid-body dynamic model and a deep neural network, which not only avoids modeling the complex friction torque but also compensates for the unmodeled factors through the deep neural network. Besides, in order to realize the leading control of the robot in the process of dragging teaching, the dynamic response relationship between the teaching motion and the external torque is equivalent to a mass damping system. An admittance control method with adaptive damping was proposed to convert the observed external torque into the desired joint angle of the teaching motion, and adaptively adjust the system damping parameters according to the change trend of the external torque to improve the teaching effect of the robot. The experiment results show that the proposed dynamic model has a lower mean square root error in the prediction torque, which can reduce the error by no less than 20%. The proposed control scheme can realize the dragging teaching without torque sensors on the six-degree-of-freedom industrial robot, and the adaptive damping method can reduce the torque required to rotate the joint by about 19%, which is more conducive to the start and stop of the teaching motion.
- Article type
- Year
Collision detection technology can reduce the probability of equipment damage and personal injury and plays an important role in modern human-robot collaborative production. To realize the collision detection without external torque sensor, it is necessary to accurately estimate the external torque of industrial robots. However, the accuracy of external torque estimation can be affected by parameters identification error of dynamic model and measurement error of motor current. To solve these problems, this paper designed a disturbance Kalman filter external torque observer based on the disturbance principle. The observer takes the equivalent external torque of external collision as the disturbance term, defines the joint disturbance model, and introduces the generalized momentum of the robot to construct the state-space equation. Considering the parameters identification error of the dynamic model and the measurement error of the motor current, it carried out an iterative estimation based on Kalman filter algorithm to obtain the optimal external torque. In order to improve the sensitivity of collision detection, a time-varying symmetric threshold function which varies with joint velocity was proposed for collision detection. The proposed method can adjust the threshold according to the change of joint velocity to adapt to the observed values of external torques at different working speeds. Experimental results show that compared with the generalized momentum observer, the accuracy of external torque estimation of the proposed observer is improved by 52.03%. In order to verify the effectiveness of the proposed method, this paper used a 6-DOF series joint industrial robot to conduct collision detection experiments. The experimental results show that compared with the static threshold, the time-varying threshold method reduces the detection delay by 58.06%, which can improve the sensitivity of collision detection and is more conducive to the safe operation and collision protection of industrial robots.
京公网安备11010802044758号