Derivation and Application of a Conserved Orbital Energy for the Inverted Pendulum Bipedal Walking Model

Similar documents
Capture Point: A Step toward Humanoid Push Recovery

Feedback Control of Dynamic Bipedal Robot Locomotion

Robust Low Torque Biped Walking Using Differential Dynamic Programming With a Minimax Criterion

Humanoid Robot Gait Generator: Foot Steps Calculation for Trajectory Following.

NUMERICAL ACCURACY OF TWO BENCHMARK MODELS OF WALKING: THE RIMLESS SPOKED WHEEL AND THE SIMPLEST WALKER

Time scaling control for an underactuated biped robot

Restricted Discrete Invariance and Self-Synchronization For Stable Walking of Bipedal Robots

Planar Bipedal Robot with Impulsive Foot Action

Symmetry in Legged Locomotion: A New Method for Designing Stable Periodic Gaits

Symmetry in Legged Locomotion: A New Method for Designing Stable Periodic Gaits

The Effect of Semicircular Feet on Energy Dissipation by Heel-strike in Dynamic Biped Locomotion

Switching and PI Control of Walking Motions of Planar Biped Walkers

Humanoid Push Recovery

C 2 Continuous Gait-Pattern Generation for Biped Robots

Bipedal Locomotion on Small Feet. Bipedal Locomotion on Small Feet. Pop Quiz for Tony 6/26/2015. Jessy Grizzle. Jessy Grizzle.

Stable Limit Cycle Generation for Underactuated Mechanical Systems, Application: Inertia Wheel Inverted Pendulum

Mechanics-Based Design of Underactuated Robotic Walking Gaits: Initial Experimental Realization

Coordinating Feet in Bipedal Balance

Sequential Composition of Walking Motions for a 5-Link Planar Biped Walker

Marc Bachelier, Sébastien Krut, Ahmed Chemori

Steering of a 3D Bipedal Robot with an Underactuated Ankle

Mechanics-Based Design of Underactuated Robotic Walking Gaits: Initial Experimental Realization

Hybrid Zero Dynamics of Planar Biped Walkers

q 1 F m d p q 2 Figure 1: An automated crane with the relevant kinematic and dynamic definitions.

Efficient Swing-up of the Acrobot Using Continuous Torque and Impulsive Braking

3D Dynamic Walking on Stepping Stones with Control Barrier Functions

Throwing Motion Control of the Pendubot and Instability Analysis of the Zero Dynamics

High gain observer for embedded Acrobot

Hybrid Zero Dynamics of Planar Bipedal Walking

Symmetric Virtual Constraints for Periodic Walking of Legged Robots

Sample-Based HZD Control for Robustness and Slope Invariance of Planar Passive Bipedal Gaits

On the Implementation of Model Predictive Control for On-line Walking Pattern Generation

APLANAR biped walker is a robot that locomotes via

DSCC OPTIMAL ROBUST TIME-VARYING SAFETY-CRITICAL CONTROL WITH APPLICATION TO DYNAMIC WALKING ON MOVING STEPPING STONES

Acknowledgements. Feedback Control of Bipedal Locomotion RAS Pioneer Award to Mark Spong. Videos and Papers

Modeling, Simulation and Control of the Walking of Biped Robotic Devices Part III: Turning while Walking

Angular Momentum Based Controller for Balancing an Inverted Double Pendulum

Limit Cycle Walking on Ice

Lecture 9 Nonlinear Control Design. Course Outline. Exact linearization: example [one-link robot] Exact Feedback Linearization

Mobile Manipulation: Force Control

Learning Arm Motion Strategies for Balance Recovery of Humanoid Robots

Video 8.1 Vijay Kumar. Property of University of Pennsylvania, Vijay Kumar

Dynamics in the dynamic walk of a quadruped robot. Hiroshi Kimura. University of Tohoku. Aramaki Aoba, Aoba-ku, Sendai 980, Japan

Designing, building, and controlling an experimental platform for the study of walking.

Highly Robust Running of Articulated Bipeds in Unobserved Terrain

Dynamics of Heel Strike in Bipedal Systems with Circular Feet

Human Gait Modeling: Dealing with Holonomic Constraints

Mimicking Human Push-Recovery Strategy based on Five-Mass with Angular Momentum Model

Mechanical energy transfer by internal force during the swing phase of running

Compliant Leg Architectures and a Linear Control Strategy for the Stable Running of Planar Biped Robots

Physics 207 Lecture 10. Lecture 10. Employ Newton s Laws in 2D problems with circular motion

Control and Planning with Asymptotically Stable Gait Primitives: 3D Dynamic Walking to Locomotor Rehabilitation?

Impactless biped walking on a slope

Planar Multi-Contact Bipedal Walking Using Hybrid Zero Dynamics

Exploiting angular momentum to enhance bipedal centerof-mass

Nonholonomic Virtual Constraints and Gait Optimization for Robust Walking Control

Dynamics and Balance Control of the Reaction Mass Pendulum (RMP): A 3D Multibody Pendulum with Variable Body Inertia

Kinematic Analysis and Computation of ZMP for a 12-internal-dof Biped Robot

Increased Robustness of Humanoid Standing Balance in the Sagittal Plane through Adaptive Joint Torque Reduction

Bringing the Compass-Gait Bipedal Walker to Three Dimensions

Design and Evaluation of a Gravity Compensation Mechanism for a Humanoid Robot

Quadratic Leaky Integrate-and-Fire Neural Network tuned with an Evolution-Strategy for a Simulated 3D Biped Walking Controller

available online at CONTROL OF THE DOUBLE INVERTED PENDULUM ON A CART USING THE NATURAL MOTION

Ankle and hip strategies for balance recovery of a biped subjected to an impact Dragomir N. Nenchev and Akinori Nishio

Nonlinear Oscillators: Free Response

Study of different structures of the knee joint for a planar bipedal robot

Robotics & Automation. Lecture 25. Dynamics of Constrained Systems, Dynamic Control. John T. Wen. April 26, 2007

Bipedal Walking Gait with Variable Stiffness Knees

MATH 415, WEEKS 7 & 8: Conservative and Hamiltonian Systems, Non-linear Pendulum

Further Analysis of the Period-Three Route to Chaos in Passive Dynamic Walking of a Compass-Gait Biped Robot

THE stance foot plays an important role in human walking

Stable Bipedal Walking with Foot Rotation Through Direct Regulation of the Zero Moment Point

to (8) yields (because ξ 1 = θ = cq and H 0 q = h 0 = h d for x Z)

Symmetry Method for Limit Cycle Walking of Legged Robots

Stepping Motion for a Human-like Character to Maintain Balance against Large Perturbations

The Dynamic Postural Adjustment with the Quadratic Programming Method

Influence of Slope Angle on the Walking of Passive Dynamic Biped Robot

CHANGING SPEED IN A SIMPLE WALKER WITH DYNAMIC ONE-STEP TRANSITIONS

Reduction-Based Control of Branched Chains: Application to Three-Dimensional Bipedal Torso Robots

Experimental comparison of several posture estimation solutions for biped robot Rabbit

Rhythmic Robot Arm Control Using Oscillators

Mechanics Departmental Exam Last updated November 2013

3. Fundamentals of Lyapunov Theory

Toward Efficient and Robust Biped Walking Optimization

Oscillatory Motion. PHYS 0212 Oscillatory Motion 1

Control of a biped robot by total rate of angular momentum using the task function approach

Manual Guidance of Humanoid Robots without Force Sensors: Preliminary Experiments with NAO

SINCE their introduction, virtual holonomic constraints

Non-Linear Response of Test Mass to External Forces and Arbitrary Motion of Suspension Point

Hopping with Nearly-Passive Flight Phases

Computer Problems for Taylor Series and Series Convergence

Acrobot stable walking in Hybrid systems notation*

Experimental Results for 3D Bipedal Robot Walking Based On Systematic Optimization of Virtual Constraints

Design and Experimental Implementation of a Compliant Hybrid Zero Dynamics Controller with Active Force Control for Running on MABEL

Lecture 13 REVIEW. Physics 106 Spring What should we know? What should we know? Newton s Laws

Application of Neural Networks for Control of Inverted Pendulum

Chapter 5. Static Non-Linear Analysis of Parallel Kinematic XY Flexure Mechanisms

Reinforcement Learning of Potential Fields to achieve Limit-Cycle Walking

Physics 207 Lecture 12. Lecture 12

2-D Passive Compass Biped Walker

Transcription:

Derivation and Application of a Conserved Orbital Energy for the Inverted Pendulum Bipedal Walking Model Jerry E. Pratt and Sergey V. Drakunov Abstract We present an analysis of a point mass, point foot, planar inverted pendulum model for bipedal walking. Using this model, we derive epressions for a conserved quantity, the Orbital Energy, given a smooth Center of Mass trajectory. Given a closed form Center of Mass Trajectory, the equation for the Orbital Energy is a closed form epression ecept for an integral term, which we show to be the first moment of area under the Center of Mass path. Hence, given a Center of Mass trajectory, it is straightforward and computationally simple to compute phase portraits for the system. In fact, for many classes of trajectories, such as those in which height is a polynomial function of Center of Mass horizontal displacement, the Orbital Energy can be solved in closed form. Given epressions for the Orbital Energy, we can compute where the foot should be placed or how the Center of Mass trajectory should be modified in order to achieve a desired velocity on the net step. We demonstrate our results using a planar biped simulation with light legs and point mass body. We parameterize the Center of Mass trajectory with a fifth order polynomial function. We demonstrate how the parameters of this polynomial and step length can be changed in order to achieve a desired net step velocity. I. INTRODUCTION Bipedal walking is difficult to analyze mathematically because the equations of motion are nonlinear, high dimensional, and a hybrid miture of continuous and discrete dynamics. In addition, the foot-ground contact forces have friction-limited, unilateral constraints. Due to these difficulties, simplified models of bipedal walking have been eplored. Many of these models have proven very useful for both analysis and control. One such simplified model is the Linear Inverted Pendulum Model of Kajita and Tanie [8]. In this model, a biped is approimated as a point mass with point feet and a Center of Mass trajectory that is constrained to a line for planar walking, or to a plane for three dimensional walking, i.e., the derivative of height with respect to forward motion or sideways motion is constant. With these constraints, the equations of motion become linear and a conserved orbital energy, the Linear Inverted Pendulum Energy can be derived. For eample, for constant height sagittal plane walking, ẍ = g z c Jerry Pratt is with Florida Institute for Human and Machine Cognition, Pensacola, Florida 3252, USA (jpratt@ihmc.us) Sergey V. Drakunov is with Florida Institute for Human and Machine Cognition, Pensacola, Florida 3252, and Tulane University, New Orleans, Louisiana 78 USA (drakunov@ieee.org) E LIP = 2ẋ2 g 2 () 2z c where is the horizontal displacement from the foot to the Center of Mass, z c is the constant Center of Mass height, g is the gravitational acceleration constant, and E LIP is the Linear Inverted Pendulum energy. Similar results have been derived for three dimensional walking [6]. Given epressions for the Linear Inverted Pendulum Energy, state space phase portraits can then be determined as they consist of curves, each corresponding to constant values of the orbital energy. If one assumes a lossless transfer of support on each step, one can then determine where to place the foot in order to achieve a new Linear Inverted Pendulum Energy, and hence the velocity on the net step. Therefore, the Linear Inverted Pendulum model gives closed form epressions of where to step in order to achieve a net step velocity. While it is only a simplified model of walking, it has been applied, as an approimation, to several bipeds that do not hold all of the assumptions used in deriving the model [7], [8]. While the Linear Inverted Pendulum model is a useful model for determining foot placement, one of its main drawbacks is that the Center of Mass trajectory is linear. In this paper, we rela the Center of Mass trajectory constraint and only constrain the trajectory to be continuous. We derive a new epression for a conserved quantity during single support, which we refer to in this paper simply as the Orbital Energy, E orbit = 2ẋ2 h 2 () + g 2 f() 3g where f(ξ)ξdξ (2) h() = f() f () (3) where z = f() is the Center of Mass height as a function of the horizontal displacement from the foot to the Center of Mass, f () is the derivative of f() with respect to and g is the acceleration of gravity. Like the Linear Inverted Pendulum Energy equation, this epression for Orbital Energy allows us to determine where to step to achieve a net step velocity, but without assuming a linear height trajectory. While it still requires the assumption of a point mass body and a point foot, we believe that its application to more complicated bipeds will be successful for several reasons including the following, Bipedal walking is an inherently robust problem, not requiring precision, accuracy, or repeatability. Hence

errors resulting from the use of simplified models can often be tolerated. Any errors introduced from the use of a simplified model often converge to an acceptable steady state error. Though a simple model may not result in a perfect controller, the choice of a good model will result in one whose feedback is qualitatively correct and quantitatively sufficient. There are many redundant opportunities for control in bipedal walking beyond the choice of footsteps. For eample, modulating the Center of Pressure on the feet, distributing forces between legs during the double support phase, and accelerating internal inertia can all be used to control velocity during walking. In the net Sections we detail the derivation of Equation 2, show eample trajectories and phase portraits, including closed form epressions for polynomial trajectories, and present simulations verifying our results. II. INVERTED PENDULUM DYNAMIC MODEL The z-plane dynamics of the inverted pendulum model rotating around the origin =, z = is Mẍ = F (4) 2 + z 2 M z = Mg + F z 2 + z 2, (5) where F is the translational knee force. Let us assume that the force F maintains the constraint z = f() between the variables and z, where f() is a function describing the Center of Mass trajectory in the zplane. We treat this constraint as a manifold in the system s 4-dimensional space defined by σ = z f() =. Differentiating σ twice we have: or σ = z f ()ẍ f ()ẋ 2 = F M 2 + z [z f ()] g f ()ẋ 2 (6) 2 If σ(t) then σ and σ, and, hence, F 2 + z = M g + f ()ẋ 2 2 z f (), F = M 2 + z 2 g + f ()ẋ 2 z f (). (7) In order to keep the state on the manifold Σ = {σ = z f() = } { σ = ż f ()ẋ = } the amplitude of the force F which creates the constraint should be not greater than the maimum permissible force F ma : F F ma. We also require that the foot should not leave the ground, so F should be nonnegative: M 2 + z 2 g + f ()ẋ 2 z f () F ma. Substituting Equation 7 into Equation 4, and since on the manifold Σ we have z f(), the equation of constrained motion along the -ais is: ẍ = g + f ()ẋ 2 f() f () (8) We now consider a few particular simple cases to verify Equation 8. In the following Sections we study in more detail the cases when f() is a polynomial of. Case I: If f() = z = const then, as one can see from Equation 8, we obtain the Linear Inverted Pendulum Dynamics presented in Equation I, ẍ = g z. Case II: If the horizontal velocity is a constant, ẋ = v = const, then v = g + f ()v 2 = f () = g v 2. and hence f() will be a parabola. Assuming that the starting -point is and the final point is and, correspondingly, z and z are starting and final heights, we have f() = g 2v 2 ( )( ) + z + z. If = and z = z : f() = g 2v 2 (2 2 ) + z. As can be easily seen such motion is a free fall with constant -speed (assuming there are no losses). The force F, in this case, is zero since in Equation 7 the term g + f ()ẋ 2 =. Case III: If f() = r 2 2, or 2 + z 2 = r 2 is a semicircle, where r = const, then in this case the easiest way to derive the motion equation is to use the polar coordinates = r sin(θ) (9) z = r cos(θ), () where θ is the angle between the direction to the point (, z) and the vertical direction. It satisfies the equation where J = Mr 2, hence J θ = rmg sin(θ), θ = g r sin(θ). This is the equation of the standard inverted pendulum with constant length, and together with Equation 9 it is equivalent to Equation 8 in this case. III. THE SOLUTION OF THE DYNAMIC EQUATIONS OF MOTION In this section we derive an eact first integral of the general constrained Equation (8), resulting in Equation 2 presented in the Introduction. Let us write Equation 8 in the standard state-space form: ẋ = 2 () ẋ 2 = g + f ( ) 2 2 f( ) f, ( ) (2)

where =, and 2 = ẋ. Considering as the independent variable, the system ()-(2) can be written as one equation: d 2 g + f ( ) 2 2 = d [f( ) f, (3) ( ) ] 2 or returning to the original notation for =, and using a new notation Y () = 2 2 = ẋ 2 we obtain Y () = 2 g + f ()Y () [f() f ()] 2f () = f() f () Y () + 2g f() f (). (4) Equation 4 is a linear first order differential equation with a variable coefficient with respect to the unknown function Y (): Y () = φ()y () + ψ(), (5) where and φ() = ψ() = 2f () f() f (), 2g f() f (). The solution of (5) can be written as Y () = Φ(, )Y ( ) + Φ(, ξ)ψ(ξ)dξ, where Φ(, ) is a fundamental solution: [ ] Φ(, ) = ep φ(ξ)dξ [ 2ξf ] (ξ) = ep f(ξ) f (ξ)ξ dξ { d[f(ξ) f } (ξ)ξ] = ep 2 f(ξ) f (ξ)ξ = ep { 2 log[f() f ()] + 2 log[f( ) f ( ) ]} [ f( ) f ] 2 ( ) = f() f. (6) () Therefore, we have [ f( ) f ] 2 ( ) Y () = f() f Y ( ) () [ f(ξ) f ] 2 (ξ)ξ ξ +2g f() f () f(ξ) f (ξ)ξ dξ [ f( ) f ] 2 ( ) = f() f Y ( ) () 2g + [f() f ()] 2 [f(ξ) f (ξ)ξ] ξdξ. (7) The last equation means that ẋ 2 [f() f ()] 2 2 [f( ) f ( ) ] 2 = 2g [f(ξ) f (ξ)ξ] ξdξ. (8) Let s introduce a function h() as then (8) can be written as Since h() = f() f (), (9) ẋ 2 h 2 () 2 h 2 ( ) = 2g h(ξ)ξdξ = = 3 we can write (8) as or h(ξ)ξdξ. (2) [f(ξ) f (ξ)ξ] ξdξ f(ξ)ξdξ 2 f() + 2 f( ), (2) 2ẋ2 h 2 () 2 2 h 2 ( ) = 3g f(ξ)ξdξ g 2 f() + g 2 f( ), (22) 2ẋ2 h 2 () + g 2 f() 3g f(ξ)ξdξ = 2 2 h 2 ( ) + g 2 f( ), (23) Collecting all the terms dependent on on the left hand side, and the terms dependent on the initial conditions on the right hand side we have 2ẋ2 h 2 () + g 2 f() 3g f(ξ)ξdξ = 2 2 h 2 ( ) + g 2 f( ) 3g f(ξ)ξdξ. (24) We see that the left hand side of the last epression is a conserved quantity during the evolution of the dynamic equations of motion and is the Orbital Energy we introduced in the Introduction (2), E orbit = 2ẋ2 h 2 () + g 2 f() 3g Thus, (24) can be interpreted as de orbit =. dt IV. VELOCITY CONTROL f(ξ)ξdξ Given the epression for Orbital Energy in Equation 2, we can determine where to step to achieve a desired net step velocity using the following method. If we let v des be the desired velocity at the top of the net stride (when = ), then E des = 2 v2 desh 2 () (25) This is the Orbital Energy that needs to be achieved as a result of the step, E des = 2 2 h 2 ( ) + g 2 f( ) 3g f(ξ)ξdξ (26) We then can solve Equations 25 and 26 for, which gives us the location to step to achieve the desired velocity.

Note that if we assume lossless steps, then we can assume that the initial velocity of the net step ( ) equals the end of velocity of the current step. Otherwise, we need to use an impact model to determine the velocity loss due to impact. The above method assumes that f() and h() are given. However, note that on each step we don t have to choose the same function f() and we can adapt this function to the conditions on the net step. Although, to prevent the magnitude of the force F from becoming infinite, it is important to have smooth connections between steps so that on the net step the following conditions are fulfilled: f old ( old ) = f new (new ), (27) f old( old ) = f new(new ), (28) ẋ(t old ) = ẋ(t new ). (29) Here f old and f new are functions f on the previous and the net step, while old and new represent the same spatial point in the coordinate frame of the previous and the net step, respectively. Similarly, t old and t new is the same time moment when the new step is done. The conditions (27) and (28) mean that there is no jump in the height of the center of gravity and the velocity vector direction, while (29) means that there is no jump in the velocity magnitude. As a special case of velocity control, let us consider a problem of choosing the step size to stop the walking system. The system is stopped when the state trajectory reaches the origin of the constrained system phase space ( =, ẋ = ). The phase trajectory which leads into the origin is defined by the points and, which correspond to an Orbital Energy of.. This also corresponds to Equation 22 having a solution =, ẋ =, i.e. 2 h 2 ( ) = 2g V. POLYNOMIAL TRAJECTORIES h(ξ)ξdξ (3) Let us consider the situation with steady walking when the function f is the same on the net step f new = f old = f and there is a smooth connection between steps so that conditions (27-29) are fulfilled. Assume that the function f() is a polynomial of order n : f() = a i i. The corresponding function h() defined by (9) is h() = f() f () = a i ( i) i. (3) and the integral portion of the Orbital Energy is f(ξ)ξdξ = i + 2 a i i+2 (32) Thus the Orbital Energy is a polynomial function of. For different values of Orbital Energy, we get different functions Fig.. Phase portrait for a symmetric 4th order polynomial function f(). of horizontal velocity versus horizontal displacement. These level curves are the phase portrait of the dynamic equations of motion. In Figure we show such a phase portrait for the polynomial trajectory z = f() = a + a 2 2 + a 4 4 with a =.682, a 2 = 2., a 4 = 9.827. Outside the interval.33 < <.33 then f() is constant. The curves that enter and leave the origin correspond to Orbital Energy levels of.. For a linear system, those curves would correspond to the stable and unstable eigenvectors of the system. For our system, which is nonlinear, those curves are not straight lines. In both cases however, the origin is a saddle point. From f( ) = f( ), and f ( ) = f ( ) we have the following two equations for n + coefficients a i : i= a i ( i i ) = (33) a i i( i i ) =. (34) The third equation is obtained by substituting (3) into (22) i a i i + 2 (i+2 i+2 ) =, (35) As an eample, if n 3 then these equations are a ( ) + a 2 ( 2 2 ) + a 3 ( 3 3 ) = a 2 2( ) + a 3 3( 2 2 ) = a 2 (2 2 ) a 2 4 (4 4 ) 2 a 3 5 (5 5 ) =

For symmetric legs, when = a + a 3 3 = (36) a 2 2 = (37) 2 a 3 5 5 =. (38) This leaves only one possible solution f() const = a. So, we need to consider n > 3. For n 5 we have a ( ) + a 2 ( 2 2 ) +a 3 ( 3 3 ) + a 4 ( 4 4 ) + a 5 ( 5 5 ) = a 2 2( ) + a 3 3( 2 2 ) +a 4 4( 3 3 ) + a 5 5( 4 4 ) = a 2 (2 2 ) a 2 4 (4 4 2 ) a 3 5 (5 5 ) a 4 2 (6 6 ) a 5 4 7 (7 7 ) =. For the symmetric legs, when = or a 2 + a 3 2 3 + a 5 2 5 = (39) a 2 4 + a 4 8 3 = (4) 4 5 a 3 5 8 7 a 5 7 =, (4) a + a 3 2 + a 5 4 = (42) a 2 2 + a 4 4 2 = (43) 5 a 3 2 7 a 5 2 =, (44) Therefore, in this case, f() has three free parameters. Choosing as these parameters the coefficients a, a 4 and a 5 this function can be written as f() = a + 3 7 4 a 5 2a 4 2 2 7 2 a 5 3 +a 4 4 +a 5 5. As can be seen from this epression f( ) = f( ) = f( ) = a a 4 4. The derivative of f() is f () = 3 7 4 a 5 4a 4 2 3 7 2 a 5 2 + 4a 4 3 + 5a 5 4. Correspondingly f ( ) = f ( ) = f ( ) = 8 7 4 a 5. The corresponding function h() = f() f () is h() = a + 2a 4 2 2 + 2 7 2 a 5 3 3a 4 4 4a 5 5. (45) Fig. 2. Fifth order polynomial function f(), matching the smooth connection constraints, with differing values of a 5. A. Stopping Condition for Polynomial Trajectories We can derive the stopping condition for the polynomial trajectory using Equation 3, ẋ 2 h 2 ( ) = 2g h(ξ)ξdξ, where in the new frame (with respect to the new rotation point) corresponds to the current, when the new step is made. We now assume a slightly more general situation when the command to stop comes not necessarily when the previous step is finished, but at an arbitrary moment at which the z-coordinate is z, and the horizontal and vertical velocities respectively are and ż. Thus, if we assume further motion to satisfy the constraint z = f new () we have the following smooth connection conditions: and Then for the polynomial f new ( ) = z, f new( ) = ż. f() = a i i, the corresponding constraints and the stopping condition (3) are a i i = z (46) 2g i= ia i i = ż (47) [ i a i i + 2 i+2 = z ż ] 2, (48) In this case the minimum degree of a non-constant polynomial can be n 3 and we have

the foot to the body mass, using a proportional-derivative plus feed-forward computed torque command, Fig. 3. Simulation results of single-leg, point mass, planar biped model showing horizontal velocity, Orbital Energy, horizontal displacement, and vertical displacement. Note that the Orbital Energy stayed constant to within 3 decimal places. Error beyond that is attributed to numerical effects of discrete simulation. a + a + a 2 2 + a 3 3 = z (49) a + 2a 2 + 3a 3 2 = ż (5) ga 2 g 2 a 2 4 g 4 [ ] 2 5 a 3 5 = z ż,(5) These equations allow us to find the polynomial and the point. VI. SIMULATION RESULTS To validate our theoretical results, we performed a sequence of simulation eperiments on two simulation models using the Yobotics Simulation Construction Set software package. The first model consisted of a free pin joint at the ground and an actuated translational leg joint, ending in a point mass body of 25.kg. The second model consisted of a planar biped with body mass of 25.kg, and legs with point mass feet, each of.5kg. This model had rotational hip joints and translational knee joints. In both systems, the support leg was actuated to control the body s height as a function of the horizontal distance from f knee = k z (f() z) + b z (f ()ẋ ż) +M 2 + z 2 g + f ()ẋ 2 z f () (52) where k z is the proportional gain and b z is the derivative gain. For the first model, the system was given appropriate initial conditions and controlled to follow f(). Because this model eactly matches the model which was used in the derivation of Equation 2, the Orbital Energy stayed constant to within 3 decimal points, as shown in Figure 3. This was verified for a variety of polynomial trajectories, thus validating Equation 2. For the second model, we developed a control algorithm with the following characteristics: Track the Center of Mass height trajectory f() using Equation 52, where f() is constant when >. This will guarantee a smooth connection at echangeof-support. Determine the net step distance by solving Equation 26 for. Swing the swing leg to the desired step location using a proportional-derivative (PD) controller on the swing hip. Apply an equal and opposite hip torque to the support hip to prevent any pitch disturbance on the body. Place the swing leg when the horizontal displacement from the foot to the Center of Mass passes a desired echange-of-support threshold. Ensure that the echange-of-support threshold is large enough so that f() is in a flat region ( ). Also, delay echangeof-support if necessary until the desired step location is in the flat region of f(). To ensure a smooth connection, we used a symmetric polynomial f() = a + a 2 2 + a 4 4 with f() = z if where = a2 2a 4, corresponding to the point of zero slope of the polynomial. Using this algorithm, we achieved walking with the planar biped model and were able to validate our theoretical results. Figure 4 shows results from a simulation in which the desired top-of-support velocity was changed between. m s to.5 m s. The Center of Mass trajectory f() stayed fied with a =.9375, a 2 = 2., and a 4 = 3.864, corresponding to =.8 and z =.95. The desired echange-of-support horizontal displacement also stayed fied at.25m. We see that velocity tracking was quite accurate, the Orbital Energy was nearly constant during the support phase, echange-ofsupport occurred at the desired value, ecept when it had to be delayed to accelerate the robot, and the Center of Mass height tracking was nearly perfect. Note that the desired Orbital Energy changed in proportion to the square of the desired velocity. Figure 5 shows results from a simulation in which the desired echange-of-support horizontal displacement was

Fig. 4. Simulation results. The desired top-of-support horizontal velocity was changed between. m s and.5 m, while the desired polynomial Center s of Mass trajectory and echange of support horizontal displacement stayed fied. Fig. 5. Simulation results. The desired echange of support horizontal displacement was changed between.25m and.45m, while the desired top-of-support horizontal velocity and polynomial Center of Mass trajectory stayed fied. changed between.2m and.45m, while the desired topof-support velocity stayed fied at. m s and the Center of Mass trajectory stayed fied with the same values as in Figure 4. Again, we see that velocity tracking was quite accurate, the Orbital Energy was nearly constant during the support phase, and the Center of Mass height tracking was nearly perfect. Echange-of-support occurred near the desired value, but there was some error due to control delays between determining it was time to place the foot and the time that foot placement actually occurred. Note that the desired Orbital Energy remained constant, as the desired topof-support velocity and height remained constant. Figure 6 shows results from a simulation in which the desired Center of Mass trajectory changed while the desired top-of-support velocity stayed fied at. m s and the desired echange-of-support displacement stayed fied at.25m. Again, we see that velocity tracking was quite accurate, the Orbital Energy was nearly constant during the support phase, echange-of-support occurred near the desired value, and the Center of Mass height tracking was nearly perfect. Note that the desired Orbital Energy changed in proportion to the square of the desired top-of-support height. VII. CONCLUSIONS AND FUTURE WORK We presented an analysis of the point mass, point foot, planar inverted pendulum model for bipedal walking, resulting in an epression for a conserved Orbital Energy. We then showed that the epression for Orbital Energy can be used to determine the net step location in order to control the net step velocity. This work was motivated by Kajita and Tanie s original Linear Inverted Pendulum Model [8] of walking, but etends on that model by not requiring a constant height or constant slope Center of Mass trajectory.

how angular momentum can be used to control velocity, and in particular how it can etend the Capture Region, the region on the ground in which a biped can come to a stop if its foot is placed in that region. Each etension of these simple models closes the gap between the model and the full dynamics of a bipedal robot. With each improvement we can more accurately compute things such as where to place the foot in order to achieve a net step velocity, or in order to regain balance after a disturbance. Net steps in this direction include: Etending the results of this paper to 3D walking. Combining the results from the Linear Inverted Pendulum plus Flywheel model to arbitrary Center of Mass trajectories. Applying the results of this paper to a real, rather than simulated, bipedal walking robot. VIII. ACKNOWLEDGMENTS Support for this work was provided by Honda Research Institute and the Office of Naval Research. Fig. 6. Simulation results. The desired Center of Mass trajectory was changed while the desired top-of-support horizontal velocity and echange of support horizontal displacement stayed fied. Following a function z = f() fully constrains the internal configuration degrees of freedom of the robot, which has been shown by Grizzle, Chevallereau, Westervelt, and colleagues [], [2], [3], [5] to allow the remaining lower degreeof-freedom dynamics to be more easily analyzed. Their prior work has shown that once the internal configuration degrees are constrained as a function of the unconstrained degrees of freedom, that a conserved Orbital Energy eists. In the general case, the conserved Orbital Energy is a very complicated epression. In this paper we showed that for the point-mass inverted pendulum model, the epression is fairly simple with only one simple integral that happens to be the first moment of area under the Center of Mass curve. In another study [], we etended the Linear Inverted Pendulum Model to include a flywheel body rather than a point mass body. With this Linear Inverted Pendulum Plus Flywheel Model, we found closed-form epressions relating REFERENCES [] C. Chevallereau, G. Abba, Y. Aoustin, F. Plestan, E.R. Westervelt, C. Canudas-De-Wit, and J.W. Grizzle. Rabbit: a testbed for advanced control theory. IEEE Control Systems Magazine, 23(5):57 79, 23. [2] C. Chevallereau, A. Formal sky, and D. Djoudi. Tracking a joint path for the walk of an underactuated biped. Robotica, 22(Part ):5 28, 24. [3] M. Doi, Y. Hasegawa, and T. Fukuda. Passive dynamic autonomous control of bipedal walking. Proceedings of the IEEE-RAS/RSJ International Conference on Humanoid Robots, 24. [4] E.R. Dunn and R.D. Howe. Towards smooth bipedal walking. Proceedings of the IEEE International Conference on Robotics and Automation, pages 2489 2494, 994. [5] J.W. Grizzle, E.R. Westervelt, and C. Canudas-De-Wit. Event-based pi control of an underactuated biped walker. 42nd IEEE International Conference on Decision and Control, pages 39 396, 23. [6] S. Kajita, F. Kanehiro, K. Kaneko, K. Yokoi, and H. Hirukawa. The 3d linear inverted pendulum mode: a simple modeling for a biped walking pattern generation. Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems, pages 239 246, 2. [7] S. Kajita and K. Tani. Eperimental study of biped dynamic walking. IEEE Control Systems Magazine, 6():3 9, 996. [8] S. Kajita, K. Tani, and A. Kobayashi. Dynamic walk control of a biped robot along the potential energy conserving orbit. Proceedings of the IEEE International Workshop on Intelligent Robots and Systems, pages 789 794, 99. [9] J. Pratt. Eploiting Inherent Robustness and Natural Dynamics in the Control of Bipedal Walking Robots. PhD thesis, May 2. [] J. Pratt, Chew Chee-Meng, A. Torres, P. Dilworth, and G. Pratt. Virtual model control: an intuitive approach for bipedal locomotion. International Journal of Robotics Research, 2(2):29 43, 2. [] Jerry Pratt, John Carff, Sergey Drakunov, and Ambarish Goswami. Capture point: A step toward humanoid push recovery. Proceedings of the IEEE-RAS/RSJ International Conference on Humanoid Robots, 26.