Skip to main content
Log in

A momentum-based balance controller for humanoid robots on non-level and non-stationary ground

  • Published:
Autonomous Robots Aims and scope Submit manuscript

Abstract

Recent research suggests the importance of controlling rotational dynamics of a humanoid robot in balance maintenance and gait. In this paper, we present a novel balance strategy that controls both linear and angular momentum of the robot. The controller’s objective is defined in terms of the desired momenta, allowing intuitive control of the balancing behavior of the robot. By directly determining the ground reaction force (GRF) and the center of pressure (CoP) at each support foot to realize the desired momenta, this strategy can deal with non-level and non-stationary grounds, as well as different frictional properties at each foot-ground contact. When the robot cannot realize the desired values of linear and angular momenta simultaneously, the controller attributes higher priority to linear momentum at the cost of compromising angular momentum. This creates a large rotation of the upper body, reminiscent of the balancing behavior of humans. We develop a computationally efficient method to optimize GRFs and CoPs at individual foot by sequentially solving two small-scale constrained linear least-squares problems. The balance strategy is demonstrated on a simulated humanoid robot under experiments such as recovery from unknown external pushes and balancing on non-level and moving supports.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Fig. 1
Fig. 2
Fig. 3
Fig. 4
Fig. 5
Fig. 6
Fig. 7
Fig. 8
Fig. 9
Fig. 10
Fig. 11
Fig. 12

Similar content being viewed by others

Notes

  1. The normal torque τ n also affects \(\boldsymbol {\dot {k}}\) in the transverse plane. Actually f, p, and τ n together constitute the 6 variables that correspond to the 6 variables of the spatial momentum. Usually τ n is omitted in the discussion for simplicity because its magnitude is small.

  2. During single support, the support base is identical to the foot contact area, whereas during double support on level ground, the support base is equivalent to the convex hull of the support areas of the two feet.

  3. \(\boldsymbol {\dot {q}}\) is a slight abuse of notation because we do not define nor use a vector q. However, since \(\mathsf {se(3)}\), the Lie algebra of \(\mathsf {SE(3)}\), is isomorphic to ℝ6, we will use a single vector form of \(\boldsymbol {\dot {q}}\in \mathbb {R}^{6+n}\) for convenience. [ω 0]× represents a skew-symmetric matrix of a vector ω 0.

  4. The vector δ i expresses angular momentum rate change (16) in terms of ρ i as follows:

  5. Specifically, \(\boldsymbol {\varPsi }_{k} = [\boldsymbol {\varPsi }_{k}^{0} \ldots \boldsymbol {\varPsi }_{k}^{5}]\) where

    and \(\boldsymbol {\kappa }_{k} = \boldsymbol {\dot {k}}_{\tau,d} + h ( {\boldsymbol{R}}_{r}^{1} {\boldsymbol{f}}^{b}_{r,X} - {\boldsymbol{R}}_{r}^{0} {\boldsymbol{f}}^{b}_{r,Y} + {\boldsymbol{R}}_{l}^{1} {\boldsymbol{f}}^{b}_{l,X} - {\boldsymbol{R}}_{l}^{0} {\boldsymbol{f}}^{b}_{l,Y} )\). \({\boldsymbol{R}}_{i}^{j}\) is j-th column vector of R i (i=r,l), \({\boldsymbol{f}}^{b}_{i}= {\boldsymbol{R}}_{i}^{T} {\boldsymbol{f}}_{i}\), and h is the height of foot frame from the foot sole.

References

  • Abdallah, M., & Goswami, A. (2005). A biomechanically motivated two-phase strategy for biped robot upright balance control. In IEEE international conference on robotics and automation (ICRA) (pp. 3707–3713). Barcelona, Spain.

    Google Scholar 

  • Abe, Y., da Silva, M., & Popović, J. (2007). Multiobjective control with frictional contacts. In Eurographics/ACM SIGGRAPH symposium on computer animation (pp. 249–258).

    Google Scholar 

  • Ahn, K. H., & Oh, Y. (2006). Walking control of a humanoid robot via explicit and stable CoM manipulation with the angular momentum resolution. In IEEE/RSJ international conference on intelligent robots and systems (IROS).

    Google Scholar 

  • Bloch, A. M., Krishnaprasad, P. S., Marsden, J. E., & Murray, R. M. (1996). Nonholonomic mechanical systems with symmetry. Archive for Rational Mechanics and Analysis, 136(1), 21–99.

    Article  MathSciNet  MATH  Google Scholar 

  • Choi, Y., Kim, D., Oh, Y., & You, B. J. (2007). Posture/walking control for humanoid robot based on kinematic resolution of CoM Jacobian with embedded motion. IEEE Transactions on Robotics, 23(6), 1285–1293.

    Article  Google Scholar 

  • de Lasa, M., Mordatch, I., & Hertzmann, A. (2010). Feature-based locomotion controllers. ACM Transactions on Graphics, 29(3).

  • Featherstone, R. (1987). Robot dynamics algorithms. Dordrecht: Kluwer Academic.

    Google Scholar 

  • Fujimoto, Y. (1998). Study on biped walking robot with environmental force interaction. Ph.D. Thesis, Yokohama National University.

  • Fujimoto, Y., & Kawamura, A. (1998). Simulation of an autonomous biped walking robot including environmental force interaction. IEEE Robotics & Automation Magazine, 5(2), 33–41.

    Article  Google Scholar 

  • Fujimoto, Y., Obata, S., & Kawamura, A. (1998). Robust biped walking with active interaction control between foot and ground. In IEEE international conference on robotics and automation (ICRA) (pp. 2030–2035).

    Google Scholar 

  • Goswami, A., & Kallem, V. (2004). Rate of change of angular momentum and balance maintenance of biped robots. In IEEE international conference on robotics and automation (ICRA) (pp. 3785–3790).

    Google Scholar 

  • Hofmann, A., Popovic, M., & Herr, H. (2009). Exploiting angular momentum to enhance bipedal center-of-mass control. In IEEE international conference on robotics and automation (ICRA) (pp. 4423–4429).

    Chapter  Google Scholar 

  • Huang, Q., & Nakamura, Y. (2005). Sensory reflex control for humanoid walking. IEEE Transactions on Robotics, 21(5), 977–984.

    Article  Google Scholar 

  • Hyon, S. H. (2009). Compliant terrain adaptation for biped humanoids without measuring ground surface and contact forces. IEEE Transactions on Robotics, 25(1), 171–178.

    Article  Google Scholar 

  • Hyon, S. H., Hale, J., & Cheng, G. (2007). Full-body compliant human–humanoid interaction: balancing in the presence of unknown external forces. IEEE Transactions on Robotics, 23(5), 884–898.

    Article  Google Scholar 

  • Kagami, S., Kanehiro, F., Tamiya, Y., Inaba, M., & Inoue, H. (2000). AutoBalancer: an online dynamic balance compensation scheme for humanoid robots. In Proc. of the 4th international workshop on algorithmic foundation on robotics.

    Google Scholar 

  • Kajita, S., Kanehiro, F., Kaneko, K., Fujiwara, K., Harada, K., Yokoi, K., & Hirukawa, H. (2003). Resolved momentum control: humanoid motion planning based on the linear and angular momentum. In IEEE/RSJ international conference on intelligent robots and systems (IROS) (Vol. 2, pp. 1644–1650). Las Vegas, NV, USA.

    Google Scholar 

  • Kajita, S., Kanehiro, F., Kaneko, K., Yokoi, K., & Hirukawa, H. (2001). The 3D linear inverted pendulum model: a simple modeling for a biped walking pattern generator. In IEEE/RSJ international conference on intelligent robots and systems (IROS) (pp. 239–246). Maui, Hawaii.

    Google Scholar 

  • Komura, T., Leung, H., Kudoh, S., & Kuffner, J. (2005). A feedback controller for biped humanoids that can counteract large perturbations during gait. In IEEE international conference on robotics and automation (ICRA) (pp. 2001–2007). Barcelona, Spain.

    Google Scholar 

  • Kudoh, S., Komura, T., & Ikeuchi, K. (2002). The dynamic postural adjustment with the quadratic programming method. In IEEE/RSJ international conference on intelligent robots and systems (IROS).

    Google Scholar 

  • Lawson, C. L., & Hanson, R. J. (1974). Solving least squares problems. Englewood: Prentice-Hall.

    MATH  Google Scholar 

  • Lee, S. H., & Goswami, A. (2010). Ground reaction force control at each foot: a momentum-based humanoid balance controller for non-level and non-stationary ground. In IEEE/RSJ international conference on intelligent robots and systems (IROS).

    Google Scholar 

  • Lourakis, M. (2004). Levmar: Levenberg-Marquardt nonlinear least squares algorithms in C/C++. [web page] http://www.ics.forth.gr/~lourakis/levmar/ (Jul.).

  • Macchietto, A., Zordan, V., & Shelton, C.R. (2009). Momentum control for balance. ACM Transactions on Graphics, 28(3), 80:1–80:8.

    Article  Google Scholar 

  • Michel, O. (2004). Webots: professional mobile robot simulation. International Journal of Advanced Robotic Systems, 1(1), 39–42.

    Google Scholar 

  • Mitobe, K., Capi, G., & Nasu, Y. (2004). A new control method for walking robots based on angular momentum. Mechatronics, 14(2), 163–174.

    Article  Google Scholar 

  • Muico, U., Lee, Y., Popović, J., & Popović, Z. (2009). Contact-aware nonlinear control of dynamic characters. ACM Transactions on Graphics, 28(3).

  • Murray, R. M., Li, Z., & Sastry, S. S. (1994). A mathematical introduction to robotic manipulation. Boca Raton: CRC Press.

    MATH  Google Scholar 

  • Naksuk, N., Mei, Y., & Lee, C. (2004). Humanoid trajectory generation: an iterative approach based on movement and angular momentum criteria. In IEEE/RAS international conference on humanoid robots (humanoids) (pp. 576–591).

    Chapter  Google Scholar 

  • Orin, D., & Goswami, A. (2008). Centroidal momentum matrix of a humanoid robot: Structure and properties. In IEEE/RSJ international conference on intelligent robots and systems (IROS). Nice, France.

    Google Scholar 

  • Park, J., Youm, Y., & Chung, W. K. (2005). Control of ground interaction at the zero-moment point for dynamic control of humanoid robots. In IEEE international conference on robotics and automation (ICRA) (pp. 1724–1729).

    Google Scholar 

  • Park, J., Han, J., & Park, F. (2007). Convex optimization algorithms for active balancing of humanoid robots. IEEE Transactions on Robotics, 23(4), 817–822.

    Article  Google Scholar 

  • Pollard, N. S., & Reitsma, P. S. A. (2001). Animation of humanlike characters: dynamic motion filtering with a physically plausible contact model. In Yale workshop on adaptive and learning systems.

    Google Scholar 

  • Popovic, M., Hofmann, A., & Herr, H. (2004). Angular momentum regulation during human walking: biomechanics and control. In IEEE international conference on robotics and automation (ICRA) (pp. 2405–2411).

    Google Scholar 

  • Pratt, J., Carff, J., Drakunov, S., & Goswami, A. (2006). Capture point: a step toward humanoid push recovery. In EEE-RAS/RSJ international conference on humanoid robots (humanoids).

    Google Scholar 

  • Sano, A., & Furusho, J. (1990). Realization of natural dynamic walking using the angular momentum information. In IEEE international conference on robotics and automation (ICRA) (pp. 1476–1481).

    Chapter  Google Scholar 

  • Sentis, L., Park, J., & Khatib, O. (2010). Compliant control of multicontact and center-of-mass behaviors in humanoid robots. IEEE Transactions on Robotics, 26(3), 483–501.

    Article  Google Scholar 

  • Sian, N. E., Yokoi, K., Kajita, S., Kanehiro, F., & Tanie, K. (2003). Whole body teleoperation of a humanoid robot—a method of integrating operator’s intention and robot’s autonomy. In IEEE international conference on robotics and automation (ICRA).

    Google Scholar 

  • Stark, P. B., & Parker, R. L. (1995). Bounded-variable least-squares: an algorithm and applications. Computational Statistics, 10, 129–141.

    MATH  Google Scholar 

  • Stephens, B. (2007). Integral control of humanoid balance. In IEEE/RSJ international conference on intelligent robots and systems (IROS).

    Google Scholar 

  • Stephens, B. J., & Atkeson, C. G. (2010). Dynamic balance force control for compliant humanoid robots. In IEEE/RSJ international conference on intelligent robots and systems (IROS).

    Google Scholar 

  • Sugihara, T. (2003). Mobility enhancement control of humanoid robot based on reaction force manipulation via whole body motion. Ph.D. Thesis, University of Tokyo.

  • Sugihara, T., & Nakamura, Y. (2003). Variable impedant inverted pendulum model control for a seamless contact phase transition on humanoid robot. In IEEE-RAS/RSJ international conference on humanoid robots (humanoids).

    Google Scholar 

  • Sugihara, T., Nakamura, Y., & Inoue, H. (2002). Realtime humanoid motion generation through ZMP manipulation based on inverted pendulum control. In IEEE international conference on robotics and automation (ICRA) (pp. 1404–1409).

    Google Scholar 

  • Ugurlu, B., & Kawamura, A. (2010). Eulerian ZMP resolution based bipedal walking: discussions on the rate change of angular momentum about center of mass. In IEEE international conference on robotics and automation (ICRA).

    Google Scholar 

  • Vukobratović, M., & Juričić, D. (1969). Contribution to the synthesis of biped gait. IEEE Transactions on Biomedical Engineering, 16, 1.

    Article  Google Scholar 

  • Wieber, P. B. (2005). Holonomy and nonholonomy in the dynamics of articulated motion. In Fast motions in biomechanics and robotics. Heidelberg, Germany.

    Google Scholar 

  • Ye, Y., & Liu, C. K. (2010). Optimal feedback control for character animation using an abstract model. ACM Transactions on Graphics, 29, 3.

    Article  Google Scholar 

  • Yun, S. K., & Goswami, A. (2011). Momentum-based reactive stepping controller on level and non-level ground for humanoid robot push recovery. In IEEE/RSJ international conference on intelligent robots and systems (IROS).

    Google Scholar 

  • Zhou, C., & Meng, Q. (2003). Dynamic balance of a biped robot using fuzzy reinforcement learning agents. Fuzzy Sets and Systems, 134(1), 169–187.

    Article  MathSciNet  MATH  Google Scholar 

Download references

Acknowledgements

This work was mainly done while S.H.L. was with HRI. S.H.L. was also supported in part by the Global Frontier R&D Program on “Human-Centered Interaction for Coexistence” funded by the National Research Foundation of Korea (NRF-M1AXA003-2011-0028374).

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Ambarish Goswami.

Electronic Supplementary Material

Below is the link to the electronic supplementary material.

(MP4 26.6 MB)

Rights and permissions

Reprints and permissions

About this article

Cite this article

Lee, SH., Goswami, A. A momentum-based balance controller for humanoid robots on non-level and non-stationary ground. Auton Robot 33, 399–414 (2012). https://doi.org/10.1007/s10514-012-9294-z

Download citation

  • Received:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s10514-012-9294-z

Keywords

Navigation