Centroidal dynamics of a humanoid robot

The center of mass (CoM) of a humanoid robot occupies a special place in its dynamics. As the location of its effective total mass, and consequently, the point of resultant action of gravity, the CoM is also the point where the robot’s aggregate linear momentum and angular momentum are naturally defined. The overarching purpose of this paper is to refocus our attention to centroidal dynamics: the dynamics of a humanoid robot projected at its CoM. In this paper we specifically study the properties, structure and computation schemes for the centroidal momentum matrix (CMM), which projects the generalized velocities of a humanoid robot to its spatial centroidal momentum. Through a transformation diagram we graphically show the relationship between this matrix and the well-known joint-space inertia matrix. We also introduce the new concept of “average spatial velocity” of the humanoid that encompasses both linear and angular components and results in a novel decomposition of the kinetic energy. Further, we develop a very efficient $$O(N)$$O(N) algorithm, expressed in a compact form using spatial notation, for computing the CMM, centroidal momentum, centroidal inertia, and average spatial velocity. Finally, as a practical use of centroidal dynamics we show that a momentum-based balance controller that directly employs the CMM can significantly reduce unnecessary trunk bending during balance maintenance against external disturbance.

[1]  David E. Orin,et al.  Efficient Dynamic Computer Simulation of Robotic Mechanisms , 1982 .

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

[3]  Ronald L. Huston,et al.  Dynamics of Multibody Systems , 1988 .

[4]  K. Kreutz,et al.  A Spatial Operator Algebra For Manipulator Modeling And Control , 1988, Other Conferences.

[5]  Evangelos G. Papadopoulos On the dynamics and control of space manipulators , 1990 .

[6]  Akihito Sano,et al.  Realization of natural dynamic walking using the angular momentum information , 1990, Proceedings., IEEE International Conference on Robotics and Automation.

[7]  Abhinandan Jain,et al.  A Spatial Operator Algebra for Manipulator Modeling and Control , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[8]  Kazuya Yoshida,et al.  Analysis of a redundant free-flying spacecraft/manipulator system , 1992, IEEE Trans. Robotics Autom..

[9]  H. Essén Average angular velocity , 1993, physics/0401146.

[10]  Bruno Siciliano,et al.  Modeling and Control of Robot Manipulators , 1995 .

[11]  Scott McMillan,et al.  Efficient computation of articulated-body inertias using successive axial screws , 1995, IEEE Trans. Robotics Autom..

[12]  David E. Orin,et al.  Robot dynamics: equations and algorithms , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[13]  Katsu Yamane,et al.  Dynamics computation of structure-varying kinematic chains and its application to human figures , 2000, IEEE Trans. Robotics Autom..

[14]  L. Siciliano Modelling and Control of Robot Manipulators , 2000 .

[15]  Masayuki Inaba,et al.  Online generation of humanoid walking motion based on a fast generation method of motion pattern that follows desired ZMP , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Nancy S. Pollard,et al.  Efficient synthesis of physically valid human motion , 2003, ACM Trans. Graph..

[17]  Kazuhito Yokoi,et al.  Resolved momentum control: humanoid motion planning based on the linear and angular momentum , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[18]  Kouhei Ohnishi,et al.  Attitude control of hopping robot using angular momentum , 2003, IEEE International Conference on Industrial Technology, 2003.

[19]  Kazuhisa Mitobe,et al.  A new control method for walking robots based on angular momentum , 2004 .

[20]  C. S. George Lee,et al.  Humanoid trajectory generation: an iterative approach based on movement and angular momentum criteria , 2004, 4th IEEE/RAS International Conference on Humanoid Robots, 2004..

[21]  Marko B. Popovic,et al.  Zero spin angular momentum control: definition and applicability , 2004, 4th IEEE/RAS International Conference on Humanoid Robots, 2004..

[22]  Vinutha Kallem,et al.  Rate of change of angular momentum and balance maintenance of biped robots , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[23]  Marko B. Popovic,et al.  Ground Reference Points in Legged Locomotion: Definitions, Biological Trajectories and Control Implications , 2005, Int. J. Robotics Res..

[24]  C. S. George Lee,et al.  Whole-body human-to-humanoid motion transfer , 2005, 5th IEEE-RAS International Conference on Humanoid Robots, 2005..

[25]  Ambarish Goswami,et al.  A Biomechanically Motivated Two-Phase Strategy for Biped Upright Balance Control , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[26]  Taku Komura,et al.  A Feedback Controller for Biped Humanoids that Can Counteract Large Perturbations During Gait , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

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

[28]  Alessandro De Luca,et al.  Collision Detection and Safe Reaction with the DLR-III Lightweight Manipulator Arm , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[29]  Sung-Hee Lee,et al.  Reaction Mass Pendulum (RMP): An explicit model for centroidal angular momentum of humanoid robots , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

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

[31]  David E. Orin,et al.  Centroidal Momentum Matrix of a humanoid robot: Structure and properties , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[32]  Pierre-Brice Wieber,et al.  Viability and predictive control for safe locomotion , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[33]  Marko B. Popovic,et al.  Angular momentum in human walking , 2008, Journal of Experimental Biology.

[34]  Marko B. Popovic,et al.  Exploiting angular momentum to enhance bipedal center-of-mass control , 2009, 2009 IEEE International Conference on Robotics and Automation.

[35]  Victor B. Zordan,et al.  Momentum control for balance , 2009, SIGGRAPH 2009.

[36]  David E. Orin,et al.  Whole-body humanoid control from upper-body task specifications , 2010, 2010 IEEE International Conference on Robotics and Automation.

[37]  Atsuo Kawamura,et al.  Eulerian ZMP resolution based bipedal walking: Discussions on the intrinsic angular momentum rate change about center of mass , 2010, 2010 IEEE International Conference on Robotics and Automation.

[38]  Victor B. Zordan Angular Momentum Control in Coordinated Behaviors , 2010, MIG.

[39]  Ludovic Righetti,et al.  Operational Space Control of Constrained and Underactuated Systems , 2011, Robotics: Science and Systems.

[40]  Sung-Hee Lee,et al.  A momentum-based balance controller for humanoid robots on non-level and non-stationary ground , 2012, Auton. Robots.

[41]  David E. Orin,et al.  Generation of dynamic humanoid behaviors through task-space control with conic optimization , 2013, 2013 IEEE International Conference on Robotics and Automation.