On the dynamics modeling of free-floating-base articulated mechanisms and applications to humanoid whole-body dynamics and control

We propose in this paper a general analytic scheme based on Gauss principle of least constraint for the derivation of the Lagrangian dynamics equation of motion of arbitrarily parameterized free-floating-base articulated mechanisms. The free-floating base of the mechanism is a non-actuated rigid object evolving in the 6D Lie group SE(3), the SO(3) component of which can be parameterized using arbitrary coordinate charts with equality constraints, for instance unit quaternions (also known as Euler parameters). This class of systems includes humanoid robots, and the presented formalism is particularly suitable for the whole-body dynamics modeling and control problem of such humanoid systems. Example motions of humanoid in arbitrary contact states with the environment demonstrate the originality of the approach.

[1]  Abderrahmane Kheddar,et al.  Multi-contact stances planning for multiple agents , 2011, 2011 IEEE International Conference on Robotics and Automation.

[2]  Stefan Schaal,et al.  Inverse dynamics control of floating-base robots with external constraints: A unified view , 2011, 2011 IEEE International Conference on Robotics and Automation.

[3]  Oussama Khatib,et al.  Gauss' principle and the dynamics of redundant and constrained manipulators , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[4]  Aaron Hertzmann,et al.  Feature-based locomotion controllers , 2010, SIGGRAPH 2010.

[5]  Abhinandan Jain,et al.  An analysis of the kinematics and dynamics of underactuated manipulators , 1993, IEEE Trans. Robotics Autom..

[6]  Oussama Khatib,et al.  Control of Free-Floating Humanoid Robots Through Task Prioritization , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[7]  A. Schwab,et al.  HOW TO DRAW EULER ANGLES AND UTILIZE EULER PARAMETERS , 2006 .

[8]  Pierre-Brice Wieber,et al.  Holonomy and Nonholonomy in the Dynamics of Articulated Motion , 2006 .

[9]  Nicolas Mansard,et al.  Generic dynamic motion generation with multiple unilateral constraints , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  R. Kalaba,et al.  Analytical Dynamics: A New Approach , 1996 .

[11]  Martin de Lasa,et al.  Feature-based locomotion controllers , 2010, ACM Trans. Graph..

[12]  Jovan Popovic,et al.  Multiobjective control with frictional contacts , 2007, SCA '07.

[13]  Kazuya Yoshida,et al.  Resolved motion rate control of space manipulators with generalized Jacobian matrix , 1989, IEEE Trans. Robotics Autom..

[14]  Abderrahmane Kheddar,et al.  Gauss' least constraints principle and rigid body simulations , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[15]  Abderrahmane Kheddar,et al.  Using a multi-objective controller to synthesize simulated humanoid robot motion with changing contact configurations , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Roy Featherstone,et al.  Rigid Body Dynamics Algorithms , 2007 .

[17]  Wisama Khalil,et al.  Modeling, Identification and Control of Robots , 2003 .

[18]  Vincent Padois,et al.  Synthesis of complex humanoid whole-body behavior: A focus on sequencing and tasks transitions , 2011, 2011 IEEE International Conference on Robotics and Automation.

[19]  Kenji KANEKO,et al.  Humanoid robot HRP-3 , 2004, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Susumu Tachi,et al.  Dynamic control of a manipulator with passive joints in an operational coordinate space , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[21]  M. Spong,et al.  Robot Modeling and Control , 2005 .

[22]  Steven Dubowsky,et al.  The kinematics, dynamics, and control of free-flying and free-floating space robotic systems , 1993, IEEE Trans. Robotics Autom..

[23]  S. A. Stoeter,et al.  Proceedings - IEEE International Conference on Robotics and Automation , 2003 .