A method for identifying dynamic parameters of terminal load of a six-degree-of-freedom tandem robot

Abstract

The present invention belongs to the field of six-degree-of-freedom serial robots, and discloses an identification method of six-degree-of-freedom serial robot tail-end load kinetic parameters. The method comprises the following steps of: 1) establishing a kinetic model of a six-degree-of-freedom serial robot; 2) recording an angle, an angular speed and an angular acceleration of the six-degree-of-freedom serial robot in the motion process, and collecting the motor current information of each joint; 3) obtaining the moment of each joint when the six-degree-of-freedom serial robot is no-load and the actual load moment of each joint when the six-degree-of-freedom serial robot is operated; 4) obtaining the theoretical load moment of each joint with load kinetic parameters; and 5) comparing the actual load moments with the theoretical load moments, and solving load kinetic parameters. The identification method of six-degree-of-freedom serial robot tail-end load kinetic parameters greatly reduces the complexity of multi-freedom geometric method analysis, can effectively simplify the algorithm, can improve the operation speed, and employs a dynamic particle swarm algorithm with a crossover and variation function to effectively prevent particles from falling into a locally optimal solution so as to improve the algorithm accuracy.

Description

technical field [0001] The invention belongs to the field of six-degree-of-freedom series robots, and more specifically relates to an identification method for dynamic parameters of terminal loads of six-degree-of-freedom series robots. Background technique [0002] Establishing an accurate six-degree-of-freedom serial robot dynamic model is an important condition for the high-precision control of multi-joint six-degree-of-freedom serial robots and manipulators, the improvement of system performance, and the application of high-reliability controllers. The accuracy of the six-degree-of-freedom serial robot model depends on the accuracy of the inertia parameters of each link and the load inertia of the six-degree-of-freedom serial robot. In practical applications, the inertial parameters of each link of the six-DOF series robot will not change with the change of the load after measurement. Therefore, it is only necessary to identify the load when the load changes to obtain th...

AI Technical Summary

Problems solved by technology

[0004] At present, the load parameter identification method of the six-degree-of-freedom serial robot mainly adopts the least square method or the improved least square method to obtain the high-order regression equation. This process requires high-order matrix inversion operations, and the algorithm complexity is high. Zero or kinetic parameter solutions for problems that do not satisfy constraints

Images