Numerical Estimation of Balanced and Falling States for Constrained Legged Systems

Instability and risk of fall during standing and walking are common challenges for biped robots. While existing criteria from state-space dynamical systems approach or ground reference points are useful in some applications, complete system models and constraints have not been taken into account for prediction and indication of fall for general legged robots. In this study, a general numerical framework that estimates the balanced and falling states of legged systems is introduced. The overall approach is based on the integration of joint-space and Cartesian-space dynamics of a legged system model. The full-body constrained joint-space dynamics includes the contact forces and moments term due to current foot (or feet) support and another term due to altered contact configuration. According to the refined notions of balanced, falling, and fallen, the system parameters, physical constraints, and initial/final/boundary conditions for balancing are incorporated into constrained nonlinear optimization problems to solve for the velocity extrema (representing the maximum perturbation allowed to maintain balance without changing contacts) in the Cartesian space at each center-of-mass (COM) position within its workspace. The iterative algorithm constructs the stability boundary as a COM state-space partition between balanced and falling states. Inclusion in the resulting six-dimensional manifold is a necessary condition for a state of the given system to be balanced under the given contact configuration, while exclusion is a sufficient condition for falling. The framework is used to analyze the balance stability of example systems with various degrees of complexities. The manifold for a 1-degree-of-freedom (DOF) legged system is consistent with the experimental and simulation results in the existing studies for specific controller designs. The results for a 2-DOF system demonstrate the dependency of the COM state-space partition upon joint-space configuration (elbow-up vs. elbow-down). For both 1- and 2-DOF systems, the results are validated in simulation environments. Finally, the manifold for a biped walking robot is constructed and illustrated against its single-support walking trajectories. The manifold identified by the proposed framework for any given legged system can be evaluated beforehand as a system property and serves as a map for either a specified state or a specific controller’s performance.

[1]  Joo Hyun Kim,et al.  Optimization of throwing motion planning for whole-body humanoid mechanism: Sidearm and maximum distance , 2011 .

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

[3]  Teresa Zielinska,et al.  Robot gait synthesis using the scheme of human motions skills development , 2009 .

[4]  Hajime Asama,et al.  Gait pattern generation and stabilization for humanoid robot based on coupled oscillators , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Jerry Pratt,et al.  Velocity-Based Stability Margins for Fast Bipedal Walking , 2006 .

[6]  Qiong Wu,et al.  On the Effects of Constraints on Bipedal Balance Control during Standing , 2007, 2007 American Control Conference.

[7]  Mehdi Mirzaei,et al.  Simultaneous design of optimal gait pattern and controller for a bipedal robot , 2010 .

[8]  Twan Koolen,et al.  Capturability-based analysis and control of legged locomotion, Part 1: Theory and application to three simple gait models , 2011, Int. J. Robotics Res..

[9]  Wynne A. Lee,et al.  Evaluation of a model that determines the stability limits of dynamic balance. , 1999, Gait & posture.

[10]  D. Sternad,et al.  Slower speeds in patients with diabetic neuropathy lead to improved local dynamic stability of continuous overground walking. , 2000, Journal of biomechanics.

[11]  S. Javad Hasaneini,et al.  Two steps is enough: No need to plan far ahead for walking balance , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

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

[13]  Michael A. Saunders,et al.  SNOPT: An SQP Algorithm for Large-Scale Constrained Optimization , 2002, SIAM J. Optim..

[14]  Andrew P. Murray,et al.  ON THE MANIPULABILITY OF THE CENTER OF MASS OF HUMANOID ROBOTS, APPLICATION TO DESIGN , 2010 .

[15]  Joo H. Kim,et al.  Concurrent Contact Planning and Trajectory Optimization in One Step Walking Motion , 2015 .

[16]  Branislav Borovac,et al.  Simulation model of general human and humanoid motion , 2007 .

[17]  Y. Hurmuzlu,et al.  On the measurement of dynamic stability of human locomotion. , 1994, Journal of biomechanical engineering.

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

[19]  Alfred D. Grant Gait Analysis: Normal and Pathological Function , 2010 .

[20]  G. Oriolo,et al.  Robotics: Modelling, Planning and Control , 2008 .

[21]  Flavio Firmani,et al.  Theoretical analysis of the state of balance in bipedal walking. , 2013, Journal of biomechanical engineering.

[22]  Bin Yao,et al.  Feasible Center of Mass Dynamic Manipulability of humanoid robots , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[23]  Benjamin J. Stephens,et al.  Humanoid push recovery , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

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

[25]  Martin L Tanaka,et al.  Detecting dynamical boundaries from kinematic data in biomechanics. , 2010, Chaos.

[26]  Jesus Meneses,et al.  Center of percussion and gait design of biped robots , 2010 .

[27]  Joo H. Kim,et al.  Contact Status Optimization of Multibody Dynamic Systems Using Dual Variable Transformation , 2014 .

[28]  Joo Hyun Kim,et al.  Concurrent motion planning and reaction load distribution for redundant dynamic systems under external holonomic constraints , 2011 .

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

[30]  Christopher G. Atkeson,et al.  Modeling and control of periodic humanoid balance using the Linear Biped Model , 2009, 2009 9th IEEE-RAS International Conference on Humanoid Robots.

[31]  Guy Bessonnet,et al.  Forces acting on a biped robot. Center of pressure-zero moment point , 2004, IEEE Transactions on Systems, Man, and Cybernetics - Part A: Systems and Humans.

[32]  Ambarish Goswami,et al.  Postural Stability of Biped Robots and the Foot-Rotation Indicator (FRI) Point , 1999, Int. J. Robotics Res..

[33]  Pierre-Brice Wieber On the stability of walking systems , 2002 .

[34]  Benjamin J. Stephens Integral control of humanoid balance , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[35]  Miomir Vukobratovic,et al.  Zero-Moment Point - Thirty Five Years of its Life , 2004, Int. J. Humanoid Robotics.

[36]  Q. Wu,et al.  Effects of constraints on bipedal balance control , 2006, 2006 American Control Conference.

[37]  Chang B. Joo,et al.  Numerical construction of balanced state manifold for single-support legged mechanism in sagittal plane , 2014 .

[38]  Y. Pai,et al.  Center of mass velocity-position predictions for balance control. , 1997, Journal of biomechanics.

[39]  F. Horak,et al.  Postural feedback responses scale with biomechanical constraints in human standing , 2004, Experimental Brain Research.

[40]  Carlotta Mummolo,et al.  Identification of balanced states for multi-segmental legged robots using reduced-order model , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[41]  Ambarish Goswami,et al.  Learning to Predict Humanoid Fall , 2011, Int. J. Humanoid Robotics.

[42]  Shinya Aoi,et al.  Formation mechanism of a basin of attraction for passive dynamic walking induced by intrinsic hyperbolicity , 2014, Proceedings of the Royal Society A: Mathematical, Physical and Engineering Sciences.

[43]  Hajime Asama,et al.  Development of open platform humanoid robot DARwIn-OP , 2013, Adv. Robotics.

[44]  Carlotta Mummolo,et al.  Passive and dynamic gait measures for biped mechanism: formulation and simulation analysis , 2012, Robotica.

[45]  Ambarish Goswami,et al.  Predicting Falls of a Humanoid Robot through Machine Learning , 2010, IAAI.

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

[47]  John T. Wen,et al.  Kinematic manipulability of general constrained rigid multibody systems , 1999, IEEE Trans. Robotics Autom..

[48]  Tsuneo Yoshikawa,et al.  Dynamic Manipulability of Robot Manipulators , 1985 .

[49]  Yujiang Xiang,et al.  Dynamic motion planning of overarm throw for a biped human multibody system , 2010 .

[50]  Pierre-Brice Wieber,et al.  Balance Recovery Prediction with Multiple Strategies for Standing Humans , 2016, PloS one.

[51]  Q. Wu,et al.  Effects of gravity and friction constraints on bipedal balance control , 2005, Proceedings of 2005 IEEE Conference on Control Applications, 2005. CCA 2005..

[52]  Jean-Pierre Aubin,et al.  Viability theory , 1991 .

[53]  Karim Abdel-Malek,et al.  Analytical Boundary of the Workspace for General3-DOF Mechanisms , 1997, Int. J. Robotics Res..

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

[55]  Masayuki Inaba,et al.  Dynamically-Stable Motion Planning for Humanoid Robots , 2002, Auton. Robots.

[56]  泰義 横小路,et al.  IEEE International Conference on Robotics and Automation , 1992 .

[57]  David E. Orin,et al.  Centroidal dynamics of a humanoid robot , 2013, Auton. Robots.

[58]  Carlotta Mummolo,et al.  Quantifying dynamic characteristics of human walking for comprehensive gait cycle. , 2013, Journal of biomechanical engineering.

[59]  Martijn Wisse,et al.  A Disturbance Rejection Measure for Limit Cycle Walkers: The Gait Sensitivity Norm , 2007, IEEE Transactions on Robotics.

[60]  Sukyung Park,et al.  Computational evaluation of load carriage effects on gait balance stability , 2016, Computer methods in biomechanics and biomedical engineering.