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.
Similar content being viewed by others
Notes
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.
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.
\(\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.
The vector δ i expresses angular momentum rate change (16) in terms of ρ i as follows:
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.
Abe, Y., da Silva, M., & Popović, J. (2007). Multiobjective control with frictional contacts. In Eurographics/ACM SIGGRAPH symposium on computer animation (pp. 249–258).
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).
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.
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.
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.
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.
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).
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).
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).
Huang, Q., & Nakamura, Y. (2005). Sensory reflex control for humanoid walking. IEEE Transactions on Robotics, 21(5), 977–984.
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.
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.
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.
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.
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.
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.
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).
Lawson, C. L., & Hanson, R. J. (1974). Solving least squares problems. Englewood: Prentice-Hall.
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).
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.
Michel, O. (2004). Webots: professional mobile robot simulation. International Journal of Advanced Robotic Systems, 1(1), 39–42.
Mitobe, K., Capi, G., & Nasu, Y. (2004). A new control method for walking robots based on angular momentum. Mechatronics, 14(2), 163–174.
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.
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).
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.
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).
Park, J., Han, J., & Park, F. (2007). Convex optimization algorithms for active balancing of humanoid robots. IEEE Transactions on Robotics, 23(4), 817–822.
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.
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).
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).
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).
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.
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).
Stark, P. B., & Parker, R. L. (1995). Bounded-variable least-squares: an algorithm and applications. Computational Statistics, 10, 129–141.
Stephens, B. (2007). Integral control of humanoid balance. In IEEE/RSJ international conference on intelligent robots and systems (IROS).
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).
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).
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).
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).
Vukobratović, M., & Juričić, D. (1969). Contribution to the synthesis of biped gait. IEEE Transactions on Biomedical Engineering, 16, 1.
Wieber, P. B. (2005). Holonomy and nonholonomy in the dynamics of articulated motion. In Fast motions in biomechanics and robotics. Heidelberg, Germany.
Ye, Y., & Liu, C. K. (2010). Optimal feedback control for character animation using an abstract model. ACM Transactions on Graphics, 29, 3.
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).
Zhou, C., & Meng, Q. (2003). Dynamic balance of a biped robot using fuzzy reinforcement learning agents. Fuzzy Sets and Systems, 134(1), 169–187.
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
Corresponding author
Electronic Supplementary Material
Below is the link to the electronic supplementary material.
(MP4 26.6 MB)
Rights 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
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10514-012-9294-z