Simulation of Industrial Manipulators Based on the UDU T Decomposition of Inertia Matrix

Abstract

The UDUT – U and D are respectively the upper triangular and diagonal matrices – decomposition of the generalized inertia matrix of an n-link serial manipulator, introduced elsewhere, is used here for the simulation of industrial manipulators which are mainly of serial type. The decomposition is based on the application of the Gaussian elimination rules to the recursive expressions of the elements of the inertia matrix that are obtained using the Decoupled Natural Orthogonal Complement matrices. The decomposition resulted in an efficient order n, i.e., O(n), recursive forward dynamics algorithm that calculates the joint accelerations. These accelerations are then integrated numerically to perform simulation. Using this methodology, a computer algorithm for the simulation of any n degrees of freedom (DOF) industrial manipulator comprising of revolute and/or prismatic joints is developed. As illustrations, simulation results of three manipulators, namely, a three-DOF planar manipulator, and the six-DOF Stanford arm and PUMA robot, are reported in this paper.