Dynamic Modeling Method of Multibody System of 6-DOF Robot Based on Screw Theory

摘要

An accurate dynamic model is a prerequisite for realizing precise control of industrial robots. The dynamics research of multi-degree of freedom (DOF) robots is relatively unexplored and needs to be solved urgently. In this paper, a dynamic modeling method of multibody system of 6-DOF robot is proposed based on the screw theory. The established dynamic model has a more concise and unified mathematical form, and the modular matrix expression is convenient for the control of the robot. In order to ensure that the screw method is suitable for motion in a wide range of angles, quaternions are used as generalized angular coordinates, and the model established thereby eliminates singularities and improves computational efficiency. The correctness and accuracy of the screw method is verified by the simulation example, and the modeling theory and method can provide a theoretical basis for the precise control of the robot.