Constrained Lagrangian dynamics based on reduced quasi-velocities and quasi-forces

This paper presents a formulation of Lagrangian dynamics of constrained mechanical systems in terms of reduced quasi-velocities and quasi-forces that can be used for simulation, analysis, and control purposes. In this formulation, a Cholesky decomposition of the mass matrix in conjunction with adequate orthogonal matrices is used to define reduced-quasi-velocities, input quasi-forces, and constraint quasi-forces which possess natural metric. The new state and input variables always have homogeneous units despite the generalized coordinates may involve in both translational and rotational components and the constraint wrench may involve in both force and moment components. Therefore, this formulation is inherently invariant with respect to changes in dimensional units without requiring weighting matrices. Moreover, in this formulation the equations of motion are completely decoupled from those of the constrained force. This allows the possibility of a simple force control action that is totally independent of the motion control action facilitating a hybrid force/motion control. The properties of the new dynamics formulation are investigated and subsequently force/motion tracking control and regulation of constrained multibody systems based on quasi-velocities and quasi-forces are presented.

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

[2]  Chun-Ta Chen,et al.  A Lagrangian Formulation in Terms of Quasi-Coordinates for the Inverse Dynamics of the General 6-6 Stewart Platform Manipulator , 2003 .

[3]  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.

[4]  Alessandro De Luca,et al.  On the modeling of robots in contact with a dynamic environment , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

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

[6]  B. Brogliato.  Nonsmooth Mechanics: Models, Dynamics and Control , 1999 .

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

[8]  J. P. Lasalle.  Some Extensions of Liapunov's Second Method , 1960 .

[9]  William S. Levine,et al.  The Control Handbook , 2010 .

[10]  F. Aghili,et al.  Energetically consistent model of slipping and sticking frictional impacts in multibody systems , 2020, Multibody System Dynamics.

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

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

[13]  Martin Buehler,et al.  Dynamics and control of direct-drive robots with positive joint torque feedback , 1997, Proceedings of International Conference on Robotics and Automation.

[14]  A. Laub,et al.  The singular value decomposition: Its computation and some applications , 1980 .

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

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

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

[18]  B. Ravani,et al.  On First-Order Decoupling of Equations of Motion for Constrained Dynamical Systems , 1995 .

[19]  F. Aghili,et al.  Modeling and analysis of multiple impacts in multibody systems under unilateral and bilateral constrains based on linear projection operators , 2019, Multibody System Dynamics.

[20]  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).

[21]  Gene H. Golub,et al.  Matrix computations , 1983 .

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

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

[24]  F. Aghili,et al.  Simulation of Motion of Constrained Multibody Systems Based on Projection Operator , 2003 .

[25]  B. Brogliato,et al.  On the control of finite-dimensional mechanical systems with unilateral constraints , 1997, IEEE Trans. Autom. Control..

[26]  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..

[27]  Farhad Aghili.  Non-Minimal Order Model of Mechanical Systems With Redundant Constraints for Simulations and Controls , 2016, IEEE Transactions on Automatic Control.

[28]  Oussama Khatib,et al.  A General Contact Model for Dynamically-Decoupled Force/Motion , 1997, ISER.

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

[30]  Costanzo Manes.  Recovering model consistence for force and velocity measures in robot hybrid control , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

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

[32]  Leon Y. Bahar.  On the use of quasi-velocities in impulsive motion , 1994 .

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

[34]  Joseph Duffy,et al.  Hybrid Twist and Wrench Control for a Robotic Manipulator , 1988 .

[35]  B. Brogliato.  Nonsmooth Impact Mechanics: Models, Dynamics and Control , 1996 .

[36]  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).

[37]  Bernard Brogliato,et al.  Kinetic quasi-velocities in unilaterally constrained Lagrangian mechanics with impacts and friction , 2014 .

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

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

[41]  Martin Buehler,et al.  Motion control systems with H∞ positive joint torque feedback , 2001, IEEE Trans. Control. Syst. Technol..