Geometric integration on Euclidean group with application to articulated multibody systems

Numerical integration methods based on the Lie group theoretic geometrical approach are applied to articulated multibody systems with rigid body displacements, belonging to the special Euclidean group SE(3), as a part of generalized coordinates. Three Lie group integrators, the Crouch-Grossman method, commutator-free method, and Munthe-Kaas method, are formulated for the equations of motion of articulated multibody systems. The proposed methods provide singularity-free integration, unlike the Euler-angle method, while approximated solutions always evolve on the underlying manifold structure, unlike the quaternion method. In implementing the methods, the exact closed-form expression of the differential of the exponential map and its inverse on SE(3) are formulated in order to save computations for its approximation up to finite terms. Numerical simulation results validate and compare the methods by checking energy and momentum conservation at every integrated system state.

[1]  E. Hairer,et al.  Geometric Numerical Integration: Structure Preserving Algorithms for Ordinary Differential Equations , 2004 .

[2]  L Howarth,et al.  Principles of Dynamics , 1964 .

[3]  E. Celledoni,et al.  Lie group methods for rigid body dynamics and time integration on manifolds , 2003 .

[4]  P. Olver.  Applications of lie groups to differential equations , 1986 .

[5]  Antonella Zanna,et al.  Adjoint and Selfadjoint Lie-group Methods , 2001 .

[6]  B. Owren,et al.  The Newton Iteration on Lie Groups , 2000 .

[7]  J. C. Simo,et al.  Exact energy-momentum conserving algorithms and symplectic schemes for nonlinear dynamics , 1992 .

[8]  P. Crouch,et al.  Numerical integration of ordinary differential equations on manifolds , 1993 .

[9]  E. Haug,et al.  A Recursive Formulation for Constrained Mechanical System Dynamics: Part II. Closed Loop Systems , 1987 .

[10]  Ernst Hairer,et al.  Solving Ordinary Differential Equations I: Nonstiff Problems , 2009 .

[11]  Elena Celledoni,et al.  Commutator-free Lie group methods , 2003, Future Gener. Comput. Syst..

[12]  Fernando Casas,et al.  Cost Efficient Lie Group Integrators in the RKMK Class , 2003 .

[13]  Edward J. Haug,et al.  A Recursive Formation for Constrained Mechanical Systems Dynamics: Part I, Open Loop Systems , 1987 .

[14]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[15]  S. Buss.  Accurate and efficient simulation of rigid-body rotations , 2000 .

[16]  H. Munthe-Kaas,et al.  Computations in a free Lie algebra , 1999, Philosophical Transactions of the Royal Society of London. Series A: Mathematical, Physical and Engineering Sciences.

[17]  H. Munthe-Kaas.  High order Runge-Kutta methods on manifolds , 1999 .

[18]  Roy Featherstone,et al.  Robot Dynamics Algorithms , 1987 .

[19]  J. Marsden,et al.  Discrete mechanics and variational integrators , 2001, Acta Numerica.

[20]  Zdzislaw Jackiewicz,et al.  Construction of Runge–Kutta methods of Crouch–Grossman type of high order , 2000, Adv. Comput. Math..

[21]  J. C. Simo,et al.  Unconditionally stable algorithms for rigid body dynamics that exactly preserve energy and momentum , 1991 .

[22]  Arne Marthinsen,et al.  Runge-Kutta Methods Adapted to Manifolds and Based on Rigid Frames , 1999 .

[23]  K. W. Lilly,et al.  Efficient Dynamic Simulation of Robotic Mechanisms , 1993 .

[24]  Bijoy K. Ghosh,et al.  Pose estimation using line-based dynamic vision and inertial sensors , 2003, IEEE Trans. Autom. Control..

[25]  J. C. Simo,et al.  Conserving algorithms for the dynamics of Hamiltonian systems on lie groups , 1994 .

[26]  Jonghoon Park.  Principle of Dynamical Balance for Multibody Systems , 2005 .

[27]  Frank Chongwoo Park,et al.  Numerical optimization on the Euclidean group with applications to camera calibration , 2003, IEEE Trans. Robotics Autom..

[28]  Laurent O. Jay,et al.  Structure Preservation for Constrained Dynamics with Super Partitioned Additive Runge-Kutta Methods , 1998, SIAM J. Sci. Comput..

[29]  A. Marthinsen,et al.  Modeling and Solution of Some Mechanical Problems on Lie Groups , 1998 .