A gauge-invariant formulation for constrained robotic systems using square-root factorization and unitary transformation

A gauge-invariant formulation for deriving the equations of motion of constrained or unconstrained multi-body systems (MBS) in terms of (reduced) quasi-velocities is presented. We show that the square-root factorization of mass matrix and hence the quasi-velocities are not unique, rather they are related by unitary transformations. Subsequently, we show that a particular transformation leads to significant simplification of the dynamic modeling. In this formulation the equations of motion are decoupled from those of constrained force and each system has its own independent input (that is not attainable by other formulations). This allows the possibility to develop a simpler force control action that is totally independent from the motion control action. Moreover, the square-root of the mass matrix is used to transform disparate units into homogeneous units for all the reduced quasi-velocities making the formulation suitable for hybrid force/motion control of robots.

[1]  Oussama Khatib,et al.  A unified approach for motion and force control of robot manipulators: The operational space formulation , 1987, IEEE J. Robotics Autom..

[2]  Yaakov Oshman,et al.  Eigenfactor solution of the matrix Riccati equation - A continuous square root algorithm , 1984 .

[3]  Krzysztof Kozlowski,et al.  Some remarks on two quasi-velocities approaches in PD joint space control , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[4]  A. D. Luca,et al.  On the modeling of robots in contact with a dynamic environment , 1991 .

[5]  Guillermo Rodríguez-Ortiz,et al.  Spatial operator factorization and inversion of the manipulator mass matrix , 1992, IEEE Trans. Robotics Autom..

[6]  D. Koditschek.  Robot kinematics and coordinate transformations , 1985, 1985 24th IEEE Conference on Decision and Control.

[7]  H. Anton,et al.  Contemporary Linear Algebra , 2002 .

[8]  Carlos Canudas de Wit,et al.  Theory of Robot Control , 1996 .

[9]  Nazareth Bedrossian,et al.  Linearizing coordinate transformations and Riemann curvature , 1992, [1992] Proceedings of the 31st IEEE Conference on Decision and Control.

[10]  Przemyslaw Herman.  PD Controller for Manipulator with Kinetic Energy Term , 2005, J. Intell. Robotic Syst..

[11]  Edward Y. L. Gu,et al.  A Configuration Manifold Embedding Model for Dynamic Control of Redundant Robots , 2000, Int. J. Robotics Res..

[12]  I. Bar-Itzhack,et al.  Eigenfactor solution of the matrix Riccati equation - A continuous square root algorithm , 1984, The 23rd IEEE Conference on Decision and Control.

[13]  Mark W. Spong.  Remarks on robot dynamics: canonical transformations and Riemannian geometry , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[14]  John L. Junkins,et al.  AN INSTANTANEOUS EIGENSTRUCTURE QUASIVELOCITY FORMULATION FOR NONLINEAR MULTIBODY DYNAMICS , 1997 .

[15]  Javier García de Jalón,et al.  Kinematic and Dynamic Simulation of Multibody Systems , 1994 .

[16]  N. H. McClamroch,et al.  Feedback stabilization and tracking of constrained robots , 1988 .

[17]  Krzysztof Kozlowski,et al.  A comparison of control algorithms for serial manipulators in terms of quasi-velocities , 2000, Proceedings. 2000 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2000) (Cat. No.00CH37113).

[18]  Amir Fijany,et al.  A technique for analyzing constrained rigid-body systems, and its application to the constraint force algorithm , 1999, IEEE Trans. Robotics Autom..

[19]  John G. Papastavridis,et al.  A Panoramic Overview of the Principles and Equations of Motion of Advanced Engineering Dynamics , 1998 .

[20]  K. Kozlowski,et al.  A survey of equations of motion in terms of inertial quasi-velocities for serial manipulators , 2006 .

[21]  John L. Junkins,et al.  Linear Feedback Control Using Quasi Velocities , 2006 .

[22]  You-Liang Gu,et al.  Control system modeling for robot manipulators by use of a canonical transformation , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[23]  Keith L. Doty,et al.  A Theory of Generalized Inverses Applied to Robotics , 1993, Int. J. Robotics Res..

[24]  Farhad Aghili,et al.  A unified approach for inverse and direct dynamics of constrained multibody systems based on linear projection operator: applications to control and simulation , 2005, IEEE Transactions on Robotics.

[25]  Javier García de Jalón,et al.  Kinematic and Dynamic Simulation of Multibody Systems: The Real Time Challenge , 1994 .

[26]  Paolo Rocco,et al.  Toward the implementation of hybrid position/force control in industrial robots , 1997, IEEE Trans. Robotics Autom..

[27]  Krzysztof Kozłowski,et al.  Modelling and Identification in Robotics , 1998 .

[28]  Abhinandan Jain,et al.  Diagonalized Lagrangian robot dynamics , 1995, IEEE Trans. Robotics Autom..