Experiments with a hierarchical inverse dynamics controller on a torque-controlled humanoid

Recently several hierarchical inverse dynamics controllers based on quadratic programs have been proposed for application to torque controlled robots. They have important theoretical benefits but have never been implemented on a torque controlled robot where model inaccuracies and realtime computation requirements can be problematic. In this contribution we present experimental results for the control of the lower body of a humanoid robot using these algorithms. We propose a simplification of the optimization problem that allows us to decrease computation time enough to implement it in a fast torque control loop. Experiments demonstrate the applicability of the approach. In a first experiment, we implement a momentum-based balance controller which shows robust performance in face of unknown disturbances. In a second experiment, a tracking task is evaluated to demonstrate the performance of the controller with more complicated hierarchies. Our results show that hierarchical inverse dynamics controllers can be efficiently used for feedback control of humanoid robots and that momentum-based balance control can be efficiently implemented on a real robot.

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

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

[3]  Gordon Cheng,et al.  Full-Body Compliant Human–Humanoid Interaction: Balancing in the Presence of Unknown External Forces , 2007, IEEE Transactions on Robotics.

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

[5]  Jun Morimoto,et al.  CB: Exploring neuroscience with a humanoid research platform , 2008, 2008 IEEE International Conference on Robotics and Automation.

[6]  Stefan Schaal,et al.  Inertial parameter estimation of floating base humanoid systems using partial force sensing , 2009, 2009 9th IEEE-RAS International Conference on Humanoid Robots.

[7]  Christopher G. Atkeson,et al.  Dynamic Balance Force Control for compliant humanoid robots , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[9]  Sung-Hee Lee,et al.  Ground reaction force control at each foot: A momentum-based humanoid balance controller for non-level and non-stationary ground , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

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

[12]  Stefan Schaal,et al.  Learning, planning, and control for quadruped locomotion over challenging terrain , 2011, Int. J. Robotics Res..

[13]  Gerd Hirzinger,et al.  Posture and balance control for biped robots based on contact force optimization , 2011, 2011 11th IEEE-RAS International Conference on Humanoid Robots.

[14]  Darwin G. Caldwell,et al.  On the role of load motion compensation in high-performance force control , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Twan Koolen,et al.  Capturability-based analysis and control of legged locomotion, Part 2: Application to M2V2, a lower-body humanoid , 2012, Int. J. Robotics Res..

[16]  Roland Siegwart,et al.  Hybrid Operational Space Control for Compliant Legged Systems , 2012, RSS 2012.

[17]  Nicolas Mansard,et al.  A dedicated solver for fast operational-space inverse dynamics , 2012, 2012 IEEE International Conference on Robotics and Automation.

[18]  Masayuki Inaba,et al.  Online walking pattern generation for push recovery and minimum delay to commanded change of direction and speed , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[20]  Darwin G. Caldwell,et al.  Dynamic torque control of a hydraulic quadruped robot , 2012, 2012 IEEE International Conference on Robotics and Automation.

[21]  Stefan Schaal,et al.  Quadratic programming for inverse dynamics with optimal distribution of contact forces , 2012, 2012 12th IEEE-RAS International Conference on Humanoid Robots (Humanoids 2012).

[22]  Nicholas Roy,et al.  State Estimation for Legged Robots: Consistent Fusion of Leg Kinematics and IMU , 2013 .

[23]  Stefan Schaal,et al.  Optimal distribution of contact forces with inverse-dynamics control , 2013, Int. J. Robotics Res..