0
Research Papers

Dynamics and Balance Control of the Reaction Mass Pendulum: A Three-Dimensional Multibody Pendulum With Variable Body Inertia

[+] Author and Article Information
Amit K. Sanyal

Mechanical and Aerospace Engineering,
New Mexico State University,
Las Cruces, NM 88011
e-mail: asanyal@nmsu.edu

Ambarish Goswami

Honda Research Institute US,
Mountain View, CA 94043
e-mail: agoswami@honda-ri.com

Contributed by the Dynamic Systems Division of ASME for publication in the JOURNAL OF DYNAMIC SYSTEMS, MEASUREMENT, AND CONTROL. Manuscript received November 16, 2012; final manuscript received September 22, 2013; published online November 7, 2013. Assoc. Editor: Luis Alvarez.

J. Dyn. Sys., Meas., Control 136(2), 021002 (Nov 07, 2013) (10 pages) Paper No: DS-12-1377; doi: 10.1115/1.4025607 History: Received November 16, 2012; Revised September 22, 2013

Pendulum models have been studied as benchmark problems for development of nonlinear control schemes, as well as reduced-order models for the dynamics analysis of gait, balance and fall for humanoid robots. We have earlier introduced the reaction mass pendulum (RMP), an extension of the traditional inverted pendulum models, which explicitly captures the variable rotational inertia and angular momentum of a human or humanoid. The RMP consists of an extensible “leg”, and a “body” with moving proof masses that gives rise to the variable rotational inertia. In this paper, we present a thorough analysis of the RMP, which is treated as a three-dimensional (3D) multibody system in its own right. We derive the complete kinematics and dynamics equations of the RMP system and obtain its equilibrium conditions. We show that the equilibria of this system consist of an unstable equilibrium manifold and a stable equilibrium manifold. Next, we present a nonlinear control scheme for the RMP, which is an underactuated system with three unactuated degrees of freedom (DOFs). This scheme asymptotically stabilizes this underactuated system at its unstable equilibrium manifold, with a vertically upright configuration for the “leg” of the RMP. The domain of convergence of this stabilization scheme is shown to be almost global in the state space of the RMP. Numerical simulation results verify this stability property of the control scheme and demonstrate its effectiveness in stabilizing the unstable equilibrium manifold.

FIGURES IN THIS ARTICLE
<>
Copyright © 2014 by ASME
Your Session has timed out. Please sign back in to continue.

References

Shiriaev, A. S., Ludvigsen, H., and Egeland, O., 2004, “Swinging Up the Spherical Pendulum via Stabilization of Its First Integrals,” Automatica, 40(1), pp. 73–85. [CrossRef]
Furuta, K., 2003, “Control of Pendulum: From Super Mechano-System to Human Adaptive Mechatronics,” IEEE Conference on Decision and Control, Maui, HI, pp. 1498–1507.
Astrom, K. J., and Furuta, K., 1996, “Swinging-Up a Pendulum by Energy Control,” Proceedings of the IFAC Congress, Vol. E, pp. 37–42.
Kajita, S., and Tani, K., 1991, “Study of Dynamic Biped Locomotion on Rugged Terrain,” IEEE International Conference on Robotics and Automation (ICRA), pp. 1405–1411.
Kajita, S., Kanehiro, F., Kaneko, K., Yokoi, K., and Hirukawa, H., 2001, Maui, Hawaii, “The 3D Linear Inverted Pendulum Model: A Simple Modeling for a Biped Walking Pattern Generator,” IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 239–246.
Kajita, S., Kanehiro, F., Kaneko, K., Fujiwara, K., Harada, K., Yokoi, K., and Hirukawa, H., 2003, “Biped Walking Pattern Generation by Using Preview Control of Zero-Moment Point,” IEEE International Conference on Robotics and Automation (ICRA), Taipei, Taiwan, pp. 1620–1626.
Sugihara, T., and Nakamura, Y., 2003, Germany, “Variable Impedant Inverted Pendulum Model Control for a Seamless Contact Phase Transition on Humanoid Robot,” IEEE International Conference on Humanoid Robots (Humanoids 2003).
Altendorfer, R., Saranli, U., Komsuoglu, H., Koditschek, D., Brown, H. B., Buehler, M., Moore, N., McMordie, D., and Full, R., 2001, “Evidence for Spring Loaded Inverted Pendulum Running in a Hexapod Robot,” Experimental Robotics VII, D.Rus and S.Singh, eds., Springer-Verlag, Berlin, pp. 291–302.
Komura, T., Leung, H., Kudoh, S., and Kuffner, J., 2005, Barcelona, Spain, “A Feedback Controller for Biped Humanoids That Can Counteract Large Perturbations During Gait,” IEEE International Conference on Robotics and Automation (ICRA), pp. 2001–2007.
Komura, T., Nagano, A., Leung, H., and Shinagawa, Y., 2005, September, “Simulating Pathological Gait Using the Enhanced Linear Inverted Pendulum Model,” IEEE Trans. Biomed. Eng., 52(9), pp. 1502–1513. [CrossRef] [PubMed]
Kuo, A., 2007, “The Six Determinants of Gait and the Inverted Pendulum Analogy: A Dynamic Walking Perspective,” Hum. Mov. Sci., 26(4), pp. 617–656. [CrossRef] [PubMed]
Dutta, A., and Goswami, A., 2010, “Human Postural Model that Captures Rotational Inertia,” American Society of Biomechanics, Providence, RI.
Abdallah, M., and Goswami, A., 2005, Barcelona, Spain, “A Biomechanically Motivated Two-Phase Strategy for Biped Robot Upright Balance Control,” IEEE International Conference on Robotics and Automation (ICRA), pp. 3707–3713.
Herr, H., and Popovic, M., 2008, “Angular Momentum in Human Walking,” J. Exp. Biol., 211, pp. 467–481. [CrossRef] [PubMed]
Hofmann, A., 2006, “Robust Execution of Biped Walking Tasks From Biomechanical Principles,” Ph.D. thesis, MIT, AI Lab, Cambridge, MA.
Kajita, S., Kanehiro, F., Kaneko, K., Fujiwara, K., Harada, K., Yokoi, K., and Hirukawa, H., 2003, “Resolved Momentum Control: Humanoid Motion Planning Based on the Linear and Angular Momentum,” IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Vol. 2, Las Vegas, NV, pp. 1644–1650.
Vermeulen, J., Verrelst, B., Vanderborght, B., Lefeber, D., and Guillaume, P., 2006, “Trajectory Planning for the Walking Biped “Lucy,” Int. J. Rob. Res., 25(9), pp. 867–887. [CrossRef]
Westervelt, E., Grizzle, J. W., Chevallereau, C., Choi, J. O., and Morris, B., 2007, Feedback Control of Dynamic Bipedal Robot Locomotion, CRC Press, Boca Raton, FL.
Lee, S.-H., and Goswami, A., 2007, “Reaction Mass Pendulum (RMP): An Explicit Model for Centroidal Angular Momentum of Humanoid Robots,” IEEE International Conference on Robotics and Automation (ICRA), Rome, Italy, pp. 4667–4672.
Hernandez-Garduno, A., Lawson, J. L., and Marsden, J. E., 2005, “Relative Equilibria for the Generalized Rigid Body,” J. Geometry Physics, 53, pp. 259–274. [CrossRef]
Shen, J., Sanyal, A. K., Chaturvedi, N. A., Bernstein, D. S., and McClamroch, N. H., 2004, “Dynamics and Control of a 3D Pendulum,” IEEE Conference on Decision and Control, Nassau, Bahamas, pp. 323–328.
Shen, J., Sanyal, A. K., and McClamroch, N. H., 2003, “Asymptotic Stability of Multibody Attitude Systems,” Stability and Control of Dynamical Systems with Applications, D.Liu and J.Antsaklis, eds., Birkhauser, Cambridge, MA, pp. 291–302.
Chaturvedi, N. A., Bacconi, F., Sanyal, A. K., Bernstein, D. S., and McClamroch, N. H., 2005, “Stabilization of a 3D Rigid Pendulum,” American Control Conference, Portland, OR, pp. 3030–3035.
Chaturvedi, N. A., and McClamroch, N. H., 2006, San Diego, C. A., “Global Stabilization of an Inverted 3D Pendulum including Control Saturation Effects,” IEEE Conference on Decision and Control, pp. 6488–6493.
Astrom, K., Block, A., and Spong, M., 2001, “The Reaction Wheel Pendulum,” http://decision.csl.uiuc.edu/spong/main.htm
Sanyal, A. K., and Goswami, A., 2011, “Dynamics and Control of the Reaction Mass Pendulum (RMP) As a 3D Multibody System: Application to Humanoid Modeling,” ASME Dynamic Systems and Control Conference, Arlington, VA, pp. 589–596.
Goldstein, H., 1980, Classical Mechanics, 2 ed., Addison-Wesley, Reading, MA.
Bloch, A. M., 2003, Nonholonomic Mechanics and Control, No. 24 in Interdisciplinary Texts in Mathematics, Springer–Verlag, New York.
Abraham, R., and Marsden, J. E., 1978, Foundations of Mechanics, 2 ed., Benjamin/Cummings Publishing Company, New York.
Shen, J., 2002, “Nonlinear Control of Multibody Systems With Symmetries via Shape Change,” Ph.D. thesis, University of Michigan, Ann Arbor, MI.
Khalil, H. K., 1995, Nonlinear Systems, 2 ed., Prentice-Hall, Englewood Cliffs, NJ.
Chaturvedi, N. A., McClamroch, N. H., and Bernstein, D. S., 2009, “Asymptotic Smooth Stabilization of the Inverted 3D Pendulum,” IEEE Trans. Autom. Control, 54(6), pp. 1204–1215. [CrossRef]
Sanyal, A. K., and Chaturvedi, N. A., 2008, “Almost Global Robust Attitude Tracking Control of Spacecraft in Gravity,” AIAA Guidance, Navigation and Control Conference, Honolulu, HI, pp. AIAA–2008–6979.
Sanyal, A. K., Fosbury, A., Chaturvedi, N. A., and Bernstein, D. S., 2009, “Inertia-Free Spacecraft Attitude Trajectory Tracking With Disturbance Rejection and Almost Global Stabilization,” AIAA J. Guid., Control Dyn., 32(2), pp. 1167–1178. [CrossRef]
Chaturvedi, N. A., Sanyal, A. K., and McClamroch, N. H., 2011, “Rigid-Body Attitude Control: Using Rotation Matrices for Continuous, SIngularity-Free Control Laws,” IEEE Control Syst. Mag., 31(3), pp. 30–51. [CrossRef]
Milnor, J., 1963, Morse Theory, Princeton University Press, Princeton, NJ.

Figures

Grahic Jump Location
Fig. 1

This figure illustrates the main difference between the traditional point-mass inverted pendulum model with zero rotational inertia (left) and models containing nonzero rotational inertia (right). The point mass in the traditional pendulum model forces the ground reaction force, f, to pass through the center of mass. A reaction mass type pendulum, by virtue of its nonzero rotational inertia, allows the ground reaction force to deviate from the lean line.

Grahic Jump Location
Fig. 2

Conceptual realization of the 3D RMP. The RMP consists of a telescopic leg connecting the CoP and CoM, and a rotating body. In 3D, the rotating ellipsoidal body is mechanically equivalent to six equal masses on three mutually perpendicular rotating tracks. The CoM of the RMP is fixed at the common midpoint of the tracks. This is the point about which the tracks themselves can rotate.

Grahic Jump Location
Fig. 3

Three coordinate frames are used to describe the RMP kinematics: the CoP-fixed inertial frame {I}, the leg-fixed frame {L} located at the CoM and aligned with the leg axis, and the PMA assembly-fixed frame {P} located at the CoM. ρ is the length of the RMP leg, RL is the rotation matrix from {L} to {I}, RPL is the rotation matrix from {P} to {L}, and s=[s1 s2 s3]T is the vector of locations of the three pairs of proof mass actuators in {P}.

Grahic Jump Location
Fig. 4

The RMP is shown close to an inverted orientation in the figure on the left, while the figure on the right shows the RMP close to a hanging orientation.

Grahic Jump Location
Fig. 5

Time plot of ρ − ρe for the RMP system with the feedback control scheme of Theorem 1. Here, ρe = 0.35 m and the initial value of ρ is 0.41 m.

Grahic Jump Location
Fig. 6

Time plot of the angle Φ between the reduced attitude ΓL=RLTe3 of the RMP leg and the opposite direction to uniform gravity −e3, for the RMP system with the feedback control scheme of Theorem 1. Here, Φ = 48.6 deg at the start of the simulation and the final desired value of Φ is 0 deg.

Grahic Jump Location
Fig. 7

Time plot of the velocity ρ· of extension or retraction of the RMP leg, for the RMP system with the feedback control scheme of Theorem 1. Both the initial and the final desired value of ρ· is 0 m/s.

Grahic Jump Location
Fig. 8

Time plots of the components of the angular velocity ΩL of the RMP leg, for the RMP system with the feedback control scheme of Theorem 1. Both the initial and the final desired values of these components are 0 rad/s.

Grahic Jump Location
Fig. 9

Time plots of the components of the angular velocity ΩP of the RMP PMA assembly, for the RMP system with the feedback control scheme of Theorem 1.

Grahic Jump Location
Fig. 10

Time plots of the components of the vector difference of PMA locations s and desired locations se, for the RMP system with the feedback control scheme of Theorem 1.

Grahic Jump Location
Fig. 11

Time plots of the components of the control torque vector τL applied at the ankle joint of the RMP with the feedback control scheme of Theorem 1.

Tables

Errata

Discussions

Some tools below are only available to our subscribers or users with an online account.

Related Content

Customize your page view by dragging and repositioning the boxes below.

Related Journal Articles
Related eBook Content
Topic Collections

Sorry! You do not have access to this content. For assistance or to subscribe, please contact us:

  • TELEPHONE: 1-800-843-2763 (Toll-free in the USA)
  • EMAIL: asmedigitalcollection@asme.org
Sign In