+ All Categories
Home > Documents > [IEEE 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2010) - Taipei...

[IEEE 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2010) - Taipei...

Date post: 08-Dec-2016
Category:
Upload: christine
View: 214 times
Download: 0 times
Share this document with a friend
6

Click here to load reader

Transcript
Page 1: [IEEE 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2010) - Taipei (2010.10.18-2010.10.22)] 2010 IEEE/RSJ International Conference on Intelligent Robots

Stability of Time-varying Control for an Underactuated Biped RobotBased on Choice of Controlled Outputs

Ting Wang and Christine Chevallereau

Abstractβ€” This paper studies the effect of controlled outputsselection on the walking stability for an under-actuated planarbiped robot. The control is based on tracking reference motionsexpressed as function of time. First, the reference motions areadapted at each step in order to create an hybrid zero dynamicsystem. Second, the stability of the walking gait under closed-loop control is evaluated with the linearization of the restrictedPoincare map of the hybrid zero dynamics. It shows that for thesame robot, and for the same reference trajectory, the stabilityof the walking can be modified by some pertinent choices ofcontrolled outputs. Third, we find that, at the desired momentof impact for one step, the height of swing foot is nearly zero forall the stable walking, though the configurations of the robotare not the desired configurations. Based on this, we proposea new method to choose the controlled outputs to obtain thestable walking for robot. As a result, two stable domains forthe controlled outputs selection are obtained. Furthermore, wepoint out that, this kind of control law, which based on referencemotion as a function of time, can produce better convergentproperty than that based on reference motion as a function ofa state of robot via pertinent choices of controlled outputs.

I. INTRODUCTION

The primary objective of this paper is to present a feedbackcontroller that achieve an asymptotically stable, periodicwalking gait for an under-actuated planar biped robot. Thebiped studied consists of five links, connected to form twolegs with knees and a torso. It has point feet withoutactuation between the feet and ground, so the ZMP heuristicis not applicable, and thus under actuation must be explicitlyaddressed in the feedback control design.

The control of this robot is based on tracking referencemotions. There are two groups of method which depend onthe differences of reference trajectory. The first one is basedon reference trajectory as function of time and the other oneis not. In the second method, for example, the method ofvirtual constraints, which has been proved very successful indesigning feedback controllers for stable walking in planarbipeds [9], [5], [13], [15]. A recent paper [7] extended it tothe case of spatial robots. In this method, a state quantity ofthe biped, which is strictly monotonic (i.e., strictly increasingor decreasing) along a typical walking gait, is used to replacetime in parameterizing a periodic motion of the biped. Whensuch a control has converged, the configuration of the planarrobot at the impact is the desired one but this approachinvolves parameterized reference trajectories. In fact, thisparametrization method is not usual in robotics. In addition,

Ting Wang and Christine Chevallereau are with the IRCCyN,CNRS, Ecole centrale de Nantes, 1 rue de la Noe, 44321Nantes, cedex 03, France, [email protected]@irccyn.ec-nantes.fr

it is impossible to find the strictly monotonic state for somerobots, for example, robot-semiquad [1], quadruped with acurve gait, or biped with frontal motion [11], [8].

Based on these observations, we want to propose a tool toanalyze the stability of a control based on tracking referencemotion as function of time and to propose solution to obtainstable walking. It has been observed that for the same robot,and for a same known cyclic motion, a control law basedon a reference trajectory as function of the state of a robotproduces a stable walking, while a control law based onreference motion as a function of time produces an unstablewalking [4]. In fact, for the control law based on referencemotion as a function of time, most periodic walking gaits areunstable when the controlled outputs are selected to be theactuated coordinates. In [7], the effect of output selection onthe zero dynamics is discussed first time, but this is basedon parameterized reference trajectory. Next, this approachis used successfully for the control based on time-variantreference trajectory in [14], in which a pertinent choice ofoutputs is proposed, leading to stabilization without the useof a supplemental event-based controller.

This paper focus on how to choose the control outputspertinently to improve the walking stability of biped, whichis extended from [14]. Poincare method is used to analyzethe stability of limit cycles for hybrid zero dynamics. Thenumerical simulation shows the effect of controlled outputsselection on the walking stability. A new method to choosethe control outputs is proposed based on a condition ofthe swing foot height at the desired moment of impact.As a result, two stable domains for the controlled outputsselection are obtained. We compared the control property ofthis method with the method of virtual constraints [9], [5],[13], [15]. It shows the velocity converge more quickly withour method.

II. MODEL

A. Description of the robot

The biped considered walks in a vertical xz plane. It iscomposed of a torso and two identical legs. In the simulation,the robot Rabbit is considered [16]. Each leg is composedof two links articulated by a knee. The knees and the hipsare one-degree-of-freedom rotational joints.

The gait is composed of single support phases separatedby impact phases. During the single support phase, the vectorπ‘ž = [π‘ž1, . . . , π‘ž5]

β€² (Fig. 1) describes the configuration of thebiped. The knee and hip relative angles are actuated, but theankle joint is not actuated. We define the vector of actuatedvariables π‘žπ‘Ž = [π‘ž2, . . . , π‘ž5]

β€² and unactuated variable π‘žπ‘’ = π‘ž1.

The 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems October 18-22, 2010, Taipei, Taiwan

978-1-4244-6676-4/10/$25.00 Β©2010 IEEE 4083

Page 2: [IEEE 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2010) - Taipei (2010.10.18-2010.10.22)] 2010 IEEE/RSJ International Conference on Intelligent Robots

z

xy

π‘ž1

π‘ž2

π‘ž3 π‘ž4

π‘ž5

Fig. 1. The studied biped

B. Dynamic model

The dynamic models for single support and impact (i.e.,double support) are derived here by assuming support on leg1. The models for support on leg 2 can be written in a similarway. The Euler-Lagrange equations yield the dynamic modelfor the robot in the single support phase as

𝐷(π‘ž)π‘ž +𝐻(π‘ž, π‘ž) = 𝐡 Ξ“ =

[01Γ—4

𝐼4Γ—4

]𝑒, (1)

where 𝐷(π‘ž) is the positive-definite (5Γ— 5) mass-inertiamatrix, 𝐻(π‘ž, π‘ž) is the (5Γ— 1) vector of Coriolis and gravityterms, 𝐡 is an (5Γ— 4) full-rank, constant matrix indicatingwhether a joint is actuated or not, and 𝑒 is the (4Γ— 1) vectorof input torques. The double support phase is assumed to beinstantaneous. During the impact, the biped’s configurationvariables do not change, but the generalized velocities un-dergo a jump. Defining βˆ’ and + denotes the moment justbefore and after impact respectively. As shown in [16], thisjump is linear with respect to the joint velocity before theimpact π‘žβˆ’.

π‘ž+ = 𝐼(π‘žβˆ’)π‘žβˆ’, (2)

Considering the exchange of legs, the configuration afterimpact becomes :

π‘ž+ = πΈπ‘žβˆ’, (3)

where E is a (5Γ— 5) matrix which describes the transforma-tion of two legs.

Define state variables as π‘₯ = [π‘ž, π‘ž]β€², and let π‘₯+ = [π‘ž+, π‘ž+]β€²

and π‘₯βˆ’ = [π‘žβˆ’, π‘žβˆ’]β€². Then a complete walking motion of therobot can be expressed as a nonlinear system with impulseeffects, and written as

Ξ£ :

{οΏ½οΏ½ = 𝑓(π‘₯) + 𝑔(π‘₯)𝑒 π‘₯βˆ’ /∈ 𝑆π‘₯+ = Ξ”(π‘₯βˆ’) π‘₯βˆ’ ∈ 𝑆

, (4)

where 𝑆 = {(π‘ž, π‘ž)βˆ£π‘§π‘ π‘€(π‘ž) = 0, π‘₯𝑠𝑀(π‘ž) > 0} is theswitching surface, 𝑧𝑠𝑀, π‘₯𝑠𝑀 describe coordinates of swingfoot, and 𝑒 denotes the input torques.

𝑓(π‘₯) =

[π‘ž

βˆ’π·βˆ’1(π‘ž)𝐻(π‘ž, π‘ž)

], 𝑔(π‘₯) =

[05Γ—4

π·βˆ’1(π‘ž)𝐡

],

and

π‘₯+ = Ξ”(π‘₯βˆ’) =[𝐸𝐸𝐼(π‘žβˆ’)

]π‘₯βˆ’.

III. CONTROL LAW

A. The output

Since the robot is equipped for π‘š actuators, only π‘šoutputs can be controlled. In many papers, the controlledvariables are simply the actuated variables. In fact, the choiceof the controlled variables directly affects the behavior of therobots [7], [14]. For simplicity, we limit our analysis to thecase that the controlled variables 𝑣 are linear expression ofthe configuration variables. They are expressed as:

𝑣 = 𝑀

[π‘žπ‘’π‘žπ‘Ž

]=

[𝑀1 𝑀2

] [ π‘žπ‘’π‘žπ‘Ž

], (5)

where 𝑀 is a (4 Γ— 5) constant matrix. To obtain a simpleexpression of π‘ž with respect to 𝑣 and π‘žπ‘’, we impose 𝑀2 beinvertible. The π‘š outputs that must be zeroed by the controllaw are :

𝑦 = 𝑣 βˆ’ 𝑣𝑑(𝑑) (6)

where 𝑣𝑑(𝑑) is the desired evolution of the controlled vari-ables. The function π‘žπ‘‘(𝑑) corresponding to a cyclic motion ofthe robot, which has been obtained by [6]. The cyclic motionhas been defined for one cyclic step from 𝑑 = 0 to 𝑑 = 𝑇 .In the control strategy this desired trajectory is restarted ateach impact. A more precise definition of the output is :⎧⎨

βŽ©π‘¦ = 𝑣 βˆ’ 𝑣𝑑(𝜏) π‘₯βˆ’ /∈ π‘†πœ = 1 π‘₯βˆ’ /∈ π‘†πœ+ = 0 π‘₯βˆ’ ∈ 𝑆

. (7)

For this cyclic motion, the reference motion 𝑣𝑑 is defined by

𝑣𝑑(𝜏) = π‘€π‘žπ‘‘(𝜏) = 𝑀1π‘žπ‘‘π‘’ +𝑀2π‘ž

π‘‘π‘Ž (8)

Since the reference trajectory is expressed as the functionof time, the torques depend on the state of the robot and oftime 𝜏 . To be able to consider the closed loop state as anautonomous system, we will extend the state as 𝑋 = [π‘₯, 𝜏 ]β€²,and the studied system can be written as:

Ξ£ :

{οΏ½οΏ½ = 𝑓𝑒(𝑋) + 𝑔𝑒(𝑋)𝑒(𝑋) π‘₯βˆ’ /∈ 𝑆𝑋+ = Δ𝑒(𝑋

βˆ’) π‘₯βˆ’ ∈ 𝑆, (9)

where

𝑓𝑒(𝑋) =

[𝑓(π‘₯)1

], 𝑔𝑒(𝑋) =

[𝑔(π‘₯)01Γ—4

], Δ𝑒 =

[Ξ”0

].

Considering π‘žπ‘’ = π‘ž1 and (5), the current configuration ofthe robot can be expressed as:

π‘ž =

[1 01Γ—4

βˆ’π‘€2βˆ’1𝑀1 𝑀2

βˆ’1

] [π‘žπ‘’π‘£

], (10)

In equation (1), 𝐷 and 𝐻 are defined as:

𝐷 =

[𝐷11(1Γ—1) 𝐷12(1Γ—4)

𝐷21(4Γ—1) 𝐷22(4Γ—4)

], 𝐻 =

[𝐻1(1Γ—1)

𝐻2(4Γ—1)

](11)

Then dynamic model in single support (1) is rewritten as:{(𝐷11 βˆ’π·12𝑀2

βˆ’1𝑀1)π‘žπ‘’ = βˆ’π·12𝑀2βˆ’1𝑣 βˆ’π»1(π‘ž, π‘ž)

𝑒 = (𝐷21 βˆ’π·22𝑀2βˆ’1𝑀1)π‘žπ‘’ +𝐷22𝑀2

βˆ’1𝑣 +𝐻2(π‘ž, π‘ž)(12)

4084

Page 3: [IEEE 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2010) - Taipei (2010.10.18-2010.10.22)] 2010 IEEE/RSJ International Conference on Intelligent Robots

To zero the output in (6), the control input is defined as:

𝑣 = 𝑣𝑑(𝜏)βˆ’ 𝐾𝑑

πœ€(οΏ½οΏ½ βˆ’ ��𝑑)βˆ’ 𝐾𝑝

πœ€2(𝑣 βˆ’ 𝑣𝑑), (13)

where 𝐾𝑝 > 0, 𝐾𝑑 > 0, and πœ€ > 0. Using the control (13),the desired torques 𝑒 in (12) can be calculated.

B. The Zero dynamics

The zero dynamics [10] is defined to describe the behaviorof the system when the outputs are assumed to be zero. Thereare two objectives of introducing the zero dynamics. Firstly,we want to study the effect of the uncontrolled variable π‘žπ‘’on the property of the closed-loop system with a perfectcontrol law. Our second objective is to analyze the stabilityof walking in a reduced space. If the output is zero then using(6) and the first line of (12), the zero dynamics is definedby:{

𝑣(𝑑) = 𝑣𝑑(𝜏)(𝐷11 βˆ’π·12𝑀2

βˆ’1𝑀1)π‘žπ‘’ = βˆ’π·12𝑀2βˆ’1𝑣𝑑(𝜏)βˆ’π»1(π‘ž, π‘ž)

(14)The zero dynamics can also be expressed with the vari-

ables π‘žπ‘’ and π‘žπ‘Ž. Using the equation (8), we have:

𝑀1π‘žπ‘’ +𝑀2π‘žπ‘Ž = 𝑣 = 𝑀1π‘žπ‘‘π‘’ +𝑀2π‘ž

π‘‘π‘Ž (15)

Since 𝑀2 is invertible, there exists:⎧⎨⎩

π‘žπ‘Ž(𝜏) = π‘žπ‘‘π‘Ž +π‘€βˆ’12 𝑀1(π‘ž

𝑑𝑒 βˆ’ π‘žπ‘’)

(𝐷11 βˆ’π·12𝑀2βˆ’1𝑀1)π‘žπ‘’ = βˆ’π·12(𝑀2

βˆ’1𝑀1π‘žπ‘‘π‘’

+π‘žπ‘‘π‘Ž)βˆ’π»1(π‘ž, π‘ž)(16)

This equation clearly shows that the behavior of the robotwill be affected by the value of 𝑀2

βˆ’1𝑀1. In fact, accordingto the definition of the controlled outputs 𝑣 in (5), theintroduction of 𝑀1 permits to take into account the trackingerror of the uncontrolled variable π‘žπ‘’. In the following weimpose that 𝑀2 = 𝐼4Γ—4, which is a identity matrix. When𝑀1 = [0, 0, 0, 0]β€², the controlled variables are simply theactuated variables π‘žπ‘Ž (see (5)).

We can clearly see that the dynamic properties of theswing phase zero dynamics depend on the particular choiceof the reference motion 𝑣𝑑(𝜏) or π‘žπ‘‘(𝜏). For the same de-sired periodic motion, the choice of the controlled variablesdirectly affects the zero dynamics in (16). It will be provedwith the simulation results in section V-A.

C. The Hybrid Zero dynamics

According to [16, Chap. 5], while the feedback controllaw (12) and (13) have created a zero dynamics of the stancephase dynamics, it has not created a hybrid zero dynamics,that is, the zero dynamics considering the impact model(2). If the control law could be modified so as to create ahybrid zero dynamics, then the study of the swing phase zerodynamics (14) and the impact model would be sufficient todetermine the stability of the complete system of the robot,thereby leading to a reduced-dimension stability test [12].

The reference motions are modified stride to stride so thatthey are compatible with the initial state of the robot at the

beginning of each step [7]. The new output for the feedbackcontrol design is

𝑦𝑐 = 𝑣(𝜏)βˆ’ 𝑣𝑑(𝜏)βˆ’ 𝑣𝑐(𝜏, 𝑦𝑖, ��𝑖). (17)

This output consists of the previous output (6), and acorrection term 𝑣𝑐 that depends on (6) evaluated at thebeginning of the step, specifically, 𝑦𝑖 = 𝑣(0) βˆ’ 𝑣𝑑(0) and��𝑖 = οΏ½οΏ½(0) βˆ’ ��𝑑(0). The values of 𝑦𝑖 and ��𝑖 are updated atthe beginning of each step (or at impact) and held constantthroughout the step. The function 𝑣𝑐 is taken to be a three-times continuously differentiable function of 𝜏 such that1⎧⎨

βŽ©π‘£π‘(0, 𝑦𝑖, ��𝑖) = 𝑦𝑖��𝑐(0, 𝑦𝑖, ��𝑖) = ��𝑖𝑣𝑐(𝜏, 𝑦𝑖, ��𝑖) ≑ 0, 𝜏 β‰₯ 𝑇

2 .(18)

With 𝑣𝑐 designed in this way, the initial errors of the outputand its derivative are smoothly joined to the original virtualconstraint at the middle of the step, and 𝑣𝑐 doesn’t introduceany discontinuity on the desired trajectory. In particular, forany initial error, the initial reference motion 𝑣𝑑 is exactlysatisfied by the second part of the step : 𝜏 β‰₯ 𝑇

2 .Under the new control law defined by (17), the behavior

of the robot is completely defined by the impact map andthe swing phase zero dynamics (14), where 𝑣𝑑 is replacedby 𝑣𝑑 + 𝑣𝑐, since 𝑀2 = 𝐼4Γ—4, this equation becomes :{

𝑣(𝜏) = 𝑣𝑑(𝜏) + 𝑣𝑐(𝜏, 𝑦𝑖, ��𝑖)(𝐷11 βˆ’π·12𝑀1)π‘žπ‘’ = βˆ’π·12(𝑣

𝑑 + 𝑣𝑐)βˆ’π»1(π‘ž, π‘ž)(19)

The zero dynamics manifold is defined by 𝑍 ={(𝜏, π‘ž, π‘ž)βˆ£π‘¦π‘(π‘ž) = 0, ��𝑐(π‘ž) = 0}, this manifold can beparametrized by a vector of dimension 3: (𝜏, π‘žπ‘’, π‘žπ‘’). Whenthe reference trajectory is a function of the state variable[16], the zero dynamics manifold is of dimension 2, in ourcase, the supplementary variable 𝜏 must be considered. Byintroducing 𝑣𝑐, the resulted walking motion can remain inthe manifold 𝑍 in the presence of impact phase.

IV. STABILITY ANALYSIS

The stability analysis of walking can be done with thePoincare method. Since with the chosen control law, the stateof the robot remains on the zero dynamics manifold, thestability analysis can be done in a reduced space.

Different Poincare section can be considered. Usually, forbiped, the Poincare section is defined just before the impact.This choice implies that the perturbation of the state thatare introduced for the calculation of the Jacobian of thePoincare map is such that the two legs touch the ground.As a consequence the determination of the perturbation isnot obvious. To avoid this, we will consider the Poincaresection at 𝜏 = 0.75𝑇 , at this instant the swing leg tip doesnot touch the ground and since 𝜏 = 0.75𝑇 β‰₯ 𝑇

2 the value ofthe controlled variable are not affected by 𝑣𝑐.

A restricted Poincare map is defined from π‘†πœ ∩ 𝑍 toπ‘†πœ ∩ 𝑍, where 𝑍 = {(𝜏, π‘ž, π‘ž)βˆ£π‘¦π‘(π‘ž) = 0, ��𝑐(π‘ž) = 0} and

1In our specific application, we used a four order polynomial for 0 ≀ 𝜏 ≀𝑇2

; continuity of position, velocity and acceleration is ensured at 𝜏 = 𝑇2

.

4085

Page 4: [IEEE 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2010) - Taipei (2010.10.18-2010.10.22)] 2010 IEEE/RSJ International Conference on Intelligent Robots

π‘†πœ = {(𝜏, π‘ž, π‘ž)∣𝜏 = 0.75𝑇} is the Poincare section. Thekey point is that since in 𝑍 the state of the robot can beparametrized by three independents variables, in π‘†πœ ∩ 𝑍,the state of the robot can be represented using only twoindependent variables, π‘₯𝑧 = [π‘žπ‘’(0.75𝑇 ), π‘žπ‘’(0.75𝑇 )]

β€², whereπ‘žπ‘’ denotes the unactuated joint.

The known cyclic motion π‘žπ‘‘(𝜏) gives a fixed point π‘₯π‘§βˆ— =(π‘žπ‘’

𝑑(0.75𝑇 ), π‘žπ‘‘π‘’(0.75𝑇 )) for the proposed control law forany value of 𝑀1.

The restricted Poincare map 𝑃 𝑧 : π‘†πœ ∩ 𝑍 β†’ π‘†πœ ∩ 𝑍induces a discrete-time system π‘₯π‘§π‘˜+1 = 𝑃 𝑧(π‘₯π‘§π‘˜). From [12],for πœ€ sufficiently small in (13), the linearization of 𝑃 𝑧

about a fixed-point determines exponential stability of thefull order closed-loop robot model. Define 𝛿π‘₯π‘§π‘˜ = π‘₯π‘§π‘˜ βˆ’ π‘₯π‘§βˆ—,the Poincare map linearized about the fixed-point π‘₯π‘§βˆ— givesrise to a linearized system,

𝛿π‘₯π‘§π‘˜+1 = 𝐴𝑧𝛿π‘₯π‘§π‘˜, (20)

where the (2 Γ— 2) square matrix 𝐴𝑧 is the Jacobian of thePoincare map [14].

A fixed-point of the restricted Poincare map is locallyexponentially stable, if, and only if, the eigenvalues of 𝐴𝑧

have magnitude strictly less than one [16, Chap. 4].

V. EXAMPLES

Using optimization techniques developed in [6], an op-timal cyclic motion has been defined for the robot Rabbitdescribed in section II-A. The corresponding stick-diagramof the walking gait and the joint profiles of each angle havebeen presented in [14]. To investigate the influence of thechoice of the controlled outputs (via the matrix 𝑀1) on thestability of the control law for a particular desired cyclicmotion, 𝑣𝑑(𝜏), ��𝑑(𝜏) and 𝑣𝑑(𝜏) have to be known. Since π‘žπ‘‘

are known, according to (8), the desired reference motionare defined by : ⎧⎨

βŽ©π‘£π‘‘(𝜏) = π‘€π‘žπ‘‘(𝜏)��𝑑(𝜏) = π‘€π‘žπ‘‘(𝜏)𝑣𝑑(𝜏) = π‘€π‘žπ‘‘(𝜏)

(21)

A. Stability Analysis with Different Choices of 𝑀1

It is shown that the hybrid zero dynamics depends on thechoice of the output (19). We will explore the effect of 𝑀1

on the stability of the control law.To study the stability of this control law around the

periodic motion, we need to compute the eigenvalues of 𝐴𝑧

in (20), which are noted as πœ†1,2. Generally, it is possible touse an optimization technique to find a vector 𝑀1 such thatthe maximal norm eigenvalues of 𝐴𝑧 is less than one, as:

π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ < 1, (22)

Here we use an exploration technique to illustrate the effectof the choice of the output. We fix arbitrary three componentsof 𝑀1 to zero and π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ are drawn as function of thefourth component of 𝑀1. The results are shown in Fig. 2,where the red points note that π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ < 1. In order tofind these stable points, we search more precisely of 𝑀1(𝑗),

βˆ’10 βˆ’5 0 5 100

50

100

150

𝑀1(1)

π‘šπ‘Žπ‘₯βˆ£πœ†

1,2∣

βˆ’2 0 2 40

100

200

300

400

𝑀1(2)

π‘šπ‘Žπ‘₯βˆ£πœ†

1,2∣

βˆ’5 0 50

20

40

60

80

100

120

𝑀1(3)

π‘šπ‘Žπ‘₯βˆ£πœ†

1,2∣

βˆ’10 βˆ’5 0 50

10

20

30

40

50

60

𝑀1(4)

π‘šπ‘Žπ‘₯βˆ£πœ†

1,2∣

Fig. 2. π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ versus 𝑀1(𝑗), 𝑗 = 1, 2, 3, 4, when the other threecomponents of 𝑀1 are zero.

𝑗 = 1, 2, 3, 4 near the π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ = 1. We can find threemain results from Fig. 2.1) When 𝑀1 get into some domains, the eigenvalues of

𝐴𝑧 can change to infinity, as a result, the swing foot can’ttouch the ground, but when 𝑀1 get out of it, the eigenvaluesof 𝐴𝑧 diminish instantaneously, as shown in 𝑀1(1) of Fig. 2.We observed that these domains are due to the singularity ofthe controller.π‘ƒπ‘Ÿπ‘œπ‘œπ‘“ : If we want to calculate the required torques 𝑒 in

(12), we must obtain π‘žπ‘’ using the first line of (12), whichcan be rewritten as:

π‘žπ‘’ =βˆ’π·12𝑣 βˆ’π»1(π‘ž, π‘ž)

𝐷11 βˆ’π·12𝑀1, (23)

If there exist values of 𝑀1 such that:

𝐷11 βˆ’π·12𝑀1 = 0, (24)

the controller is singularity.During the swing phase, 𝐷11 and 𝐷12 are almost constant.

At the desired impact moment 𝑇 𝑑, there are 𝐷11 β‰ˆ 24.2445,𝐷12 β‰ˆ [13.4347, 3.6283, 0.5375, 0.0410]. When 𝑀1 =[𝑀1(1), 0, 0, 0], (24) is satisfied for 𝑀1(1) = 1.8046. Asshown in 𝑀1(1) of Fig. 2, there is a jump of π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣near this value. Using the same method, we can deduce thatwhen 𝑀1 = [0, 6.6821, 0, 0]β€², 𝑀1 = [0, 0, 45.1060, 0]β€² and𝑀1 = [0, 0, 0, 592.7751]β€², the controller will be singular too.2) For some 𝑀1, there exists a minimum π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ which

leads to stable walking.3) The π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ is very sensitive to some change of 𝑀1.

When 𝑀1 is modified a little, the stable walking gait maybecome unstable.

Here points 2) and 3) show that it is possible but difficultto choose 𝑀1 leading to stable walking. In order to furtherillustrate that, we choose different values of 𝑀1 to teststability. Each component of 𝑀1 is sampled between βˆ’10and 10 with a step of 2.5 to build 94 vectors 𝑀1. For eachvector 𝑀1, the effective eigenvalues of the Poincare map,π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣, is calculated. Except some cases in which theswing foot can’t touch the ground because of the singularityof the controller, there are only 19 stable cases and 5363

4086

Page 5: [IEEE 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2010) - Taipei (2010.10.18-2010.10.22)] 2010 IEEE/RSJ International Conference on Intelligent Robots

unstable cases. The vectors 𝑀1 leading to stable walkingare scattered and there is no obvious condition of stabilitycan be determined. Is there a method to help in the choiceof 𝑀1? In the next subsection, we will try to find a way ofsettling this problem.

B. A Method for Pertinent Choice of 𝑀1

For all cases corresponding to different 𝑀1 which werepresented in the previous paragraph, we choose some walk-ing characteristics to observe whether there exists differencebetween the stable and unstable cases. They are:

βˆ™ position of πΆπ‘œπ‘€ (Center of Mass) at the desired impactmoment 𝑇 𝑑,

βˆ™ kinetic energy just before impact and after impact (see[2] and [3]),

βˆ™ errors of uncontrolled variable π‘žπ‘’ during the swingphase and at impact moment,

βˆ™ height of swing foot 𝑍𝑠𝑀 at 𝑇 𝑑.We have not observed any special relations between the

effective eigenvalues of the Poincare map π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ and thefirst three walking characteristics, but we found 𝑍𝑠𝑀 β‰ˆ 0 at𝑇 𝑑 for all stable cases, that is, π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ < 1, see Fig. 3.

To calculate 𝑍𝑠𝑀 at 𝑇 𝑑, we use the equation (16) to write:

𝑣(𝑇 𝑑) = 𝑣𝑑(𝑇 𝑑), (25)

and we suppose that there exists an error Ξ”π‘žπ‘’ on theunderactuated variable of biped π‘žπ‘’, Ξ”π‘žπ‘’ = π‘žπ‘’(𝑇 )βˆ’ π‘žπ‘’

𝑑(𝑇 ).Considering (25), (10) and 𝑀2 = 𝐼4Γ—4, there is:

π‘ž(𝑇 𝑑) = π‘žπ‘‘(𝑇 𝑑) +π‘€π‘‡Ξ”π‘žπ‘’ (26)

where 𝑀𝑇 = [1,βˆ’π‘€1]β€². We can compute 𝑍𝑠𝑀(𝑇

𝑑) withoutsimulation of the biped walking. We suppose Ξ”π‘žπ‘’ = 10βˆ’2,which is adequate to estimate the real Ξ”π‘žπ‘’ in the walkingsimulation. Then we get 𝑍𝑠𝑀(𝑇

𝑑) for all the case of 𝑀1(𝑗) ∈[βˆ’10, 10], 𝑗 = 1, 2, 3, 4, which was presented in the previoussubsection. The result is shown in Fig. 3 (we only presentthe cases of π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ < 50 ), where the red points denoteπ‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ < 1, that is, the stable cases.

0 10 20 30 40 50

βˆ’3

βˆ’2

βˆ’1

0

1

2

3

x 10βˆ’3

π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣

𝑍𝑠𝑀(𝑇

𝑑)

Fig. 3. The height of the swing foot at the end of the step 𝑍𝑠𝑀(𝑇 𝑑) withrespect to the effective eigenvalues of the Poincare map, π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣.

Based on Fig. 3, we conjecture that:A necessary condition for stable walking is 𝑍𝑠𝑀(𝑇

𝑑) β‰ˆ 0.This condition implies that the swing foot still can touch

ground at 𝑇 𝑑 with an error of the unactuated variable. Ifthere is an error on the impact moment, 𝑇 βˆ•= 𝑇 𝑑, there

0 20 40 60βˆ’10

0

10

20

30

40

50

60

70

𝑀1(3)

𝑀1(2)

βˆ’60 βˆ’40 βˆ’20 0βˆ’70

βˆ’60

βˆ’50

βˆ’40

βˆ’30

βˆ’20

βˆ’10

0

𝑀1(3)

𝑀1(2)

Fig. 4. The stable domain of 𝑀1(2) and 𝑀1(3) for two groups of solution,which is described with contour line π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ = 1

will exist not only the error of configuration and velocityof unactuated variable Ξ”π‘žπ‘’, Ξ”π‘žπ‘’, but also that of controlledvariables Δ𝑣, Ξ”οΏ½οΏ½. These errors can lead to unstable walking.The necessary condition 𝑍𝑠𝑀(𝑇

𝑑) β‰ˆ 0 avoids the error onthe impact moment, so the errors Δ𝑣 and Ξ”οΏ½οΏ½ are avoided.

Next is how to choose 𝑀1 with this necessary condition.According to (26), 𝑍𝑠𝑀 can be written with Taylor series:

𝑍𝑠𝑀(π‘ž(𝑇𝑑)) β‰ˆ 𝑍𝑠𝑀(π‘ž

𝑑(𝑇 𝑑)) + π‘ŽΞ”π‘žπ‘’ + π‘Ξ”π‘žπ‘’2 (27)

where π‘Ž = βˆ‚π‘π‘ π‘€(π‘žπ‘‘(𝑇𝑑))βˆ‚π‘ž 𝑀𝑇 and 𝑏 =

12𝑀𝑇

β€² βˆ‚2𝑍𝑠𝑀(π‘žπ‘‘(𝑇𝑑))βˆ‚π‘ž2 𝑀𝑇 . Since the function of 𝑍𝑠𝑀(π‘ž(𝑇

𝑑))is highly nonlinear, here we considered the first two termsof the Taylor series, not only the first one.

If π‘Ž and 𝑏 satisfy :

π‘Ž = 𝑏 = 0 (28)

𝑍𝑠𝑀(π‘ž(𝑇𝑑)) is close to zero for any Ξ”π‘žπ‘’.

Two constraint equations exist in (28) for four componentsof 𝑀1, so only two components can be chosen. The condition(28) leads to two groups of solution of 𝑀1, because theequation 𝑏 = 0 is a second order equation as function of𝑀1. For each group of solution, 𝑀1(1) and 𝑀1(4) arededuced from 𝑀1(2) and 𝑀1(3). Then we search different𝑀1(2) and 𝑀1(3) to analyze the stability of the system ,we can obtain large stable domain of 𝑀1 for each group ofsolution, as shown in Fig. 4, it is described with contour lineπ‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ = 1. The system is always stable as long as 𝑀1

is chosen in these domains.

C. Compare with The Method of Virtual Constraints

Here we will compare our method with the method ofvirtual constraints, which has been proved effectively indesigning feedback controllers for stable walking in planarbipeds [9], [5], [13], [15]. It is worth mentioning thatexperimental tests based on the method of virtual constraintshas been carried out successfully with Rabbit by the researchteam of J. Grizzle [16]. Here the compare of two method isbased on the same model of the robot, the same desiredtrajectory and the same method of stability analysis. It isshown that stability of an orbit is independent of the choiceof the output, as long as the constraints yield a nonsingularcontroller [16, Chap. 6]. As a result, the control propertiescan not be modified in this way. On the contrary, it can beimproved by a good choice of controlled outputs with ourmethod.

4087

Page 6: [IEEE 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2010) - Taipei (2010.10.18-2010.10.22)] 2010 IEEE/RSJ International Conference on Intelligent Robots

In general, the effective eigenvalues of the Poincare map isthe smaller the better for the stability, so we can choose 𝑀1

according to the desired property. For example, we choose𝑀1 = [1.9121,βˆ’4,βˆ’3,βˆ’1.4090] from the second solutionof Fig. 4, the result of stability analysis is π‘šπ‘Žπ‘₯ βˆ£πœ†1,2∣ =0.2392. Then the planar biped’s model in closed-loop issimulated with this 𝑀1 and the method of virtual constraints.The initial errors 0.01π‘Ÿπ‘Žπ‘‘ and 0.1π‘Ÿπ‘Žπ‘‘/𝑠 are introduced oneach joint and it’s velocity respectively. As shown in Fig. 5,for the method of virtual constraints, the configuration of therobot at the impact is the desired one but the velocity con-verge more slowly. With our method, the velocity convergeto zero after walking four steps, and the control input 𝑒 alsofollows the desired torque after these four steps. The torquesof the swing leg (see Fig. 1) are shown in Fig. 6.

0 1 2 3 4 5 6 7 8 9 10βˆ’0.02

0

0.02

0.04

0.06

0 1 2 3 4 5 6 7 8 9 10βˆ’0.05

0

0.05

0.1

0.15

the method of output selectionthe method of virtual constraints

the method of output selectionthe method of virtual constraints

Ξ”π‘ž 𝑒

(rad

)Ξ”π‘ž 𝑒

(rad

/s)

step number

step number

Fig. 5. The difference of the real values and desired values of π‘žπ‘’ at theend of each step.

0 0.5 1 1.5 2 2.5 3 3.5 4

βˆ’40

βˆ’20

0

20

0 0.5 1 1.5 2 2.5 3 3.5 4

βˆ’20

βˆ’10

0

10

20

30

the real torque the disired torque

the real torque the disired torque

𝑒(4)(𝑁

β‹…π‘š)

𝑒(3)(𝑁

β‹…π‘š)

time (s)

time (s)

Fig. 6. The torques of the swing leg, where 𝑒(3) notes the torque of torsoand 𝑒(4) notes the torque of knee.

As stated above, the stability of walking can be improvedby pertinent choice of controlled outputs, furthermore, itis possible to produce better convergent property than theprevious method for this planar bipedal model.

VI. CONCLUSIONS

In this paper, a simple planar bipedal model has beenstudied, with the objective of developing a time-variant feed-

back control law that induces asymptotically stable walking,without relying on the use of large feet. We showed that theproperty of zero dynamics of the walking model is affectedby the choice of the controlled outputs. In addition, based onthe numerical results, we conjectured a necessary conditionfor stable walking is that the height of the swing foot at thedesired impact moment is close to zero. With this necessarycondition, two large stable domains are obtained. Finally, thesimulation results proved the validity and superiority of thismethod.

VII. ACKNOWLEDGMENT

The authors want to thank J. Grizzle and C.-L. Shih fortheir contribution to this study.

REFERENCES

[1] Y. Aoustin, C. Chevallereau, and A. Formal’sky, β€œNumerical andexperimental study of a virtual quadrupedal walking robot - semiquad,”Multibody System Dynamic, 2005.

[2] F. Asano and Z.-W. Luo, β€œAsymptotically stable gait generation forbiped robot based on mechanical energy balance,” in Proceedings ofthe 2007 IEEE/RSJ International Conference on Intelligent Robots andSystems, San Diego, USA, October 2007, pp. 3328–3333.

[3] β€”β€”, β€œAsymptotic stability of dynamic bipedal gait with constraint onimpact posture,” in Proceedings of 2008 IEEE International Confer-ence on Robotics and Automation, USA, May 2008, pp. 1246–1251.

[4] C. Chevallereau, Modern Control Theory. Esculapio, Bologna (Italy),1999, ch. 7,”Under actuated biped robot”.

[5] C. Chevallereau, G. Abba, Y. Aoustin, F. Plestan, E. Westervelt, andet al., β€œRabbit: A testbed for advanced control theory,” IEEE ControlSystems, vol. 23, no. 5, pp. 57–78, 2003.

[6] C. Chevallereau and Y. Aoustin., β€œOptimal reference trajectories forwalking and running of a biped robot,” Robotica, vol. 19, no. 5, pp.557–569, 2001.

[7] C. Chevallereau, J. Grizzle, and C. Shih, β€œAsymptotically stablewalking of a five-link underactuated 3d bipedal robot,” IEEE Trans.on Robotics, vol. 25, no. 1, pp. 37–50, February 2009.

[8] T. Fukuda, M. Doi, Y. Hasegawa, and H. Kajima, Fast Motions inBiomechanics and Robotics. Springer-Verlag, 2006, chapter Multi-Locomotion Control of Biped Locomotion and Brachiation Robot.

[9] J. Grizzle, G. Abba, and F. Plestan, β€œAsymptotically stable walkingfor biped robots: Analysis via systems with impulse effects,” IEEETransactions on Automatic Control, vol. 46, pp. 51–64, January 2001.

[10] A. Isidori, Nonlinear Control Systems, 3rd ed. Berlin: Springer-Verlag, 1995.

[11] A. Kuo, β€œStabilization of lateral motion in passive dynamic walking,”International Journal of Robotics Research, vol. 18, no. 9, pp. 917–930, 1999.

[12] B. Morris and J. Grizzle, β€œHybrid invariant manifolds in systems withimpulse effects with application to periodic locomotion in bipedalrobots,” IEEE Transactions on Automatic Control, vol. 54, no. 8, pp.1751–1764, 2009.

[13] F. Plestan, J. Grizzle, E. Westervelt, and G. Abba, β€œStable walk-ing ofa 7-dof biped robot,” IEEE Transactions on Robotics and Automation,vol. 19, no. 4, pp. 653–668, 2003.

[14] T. Wang, C. Chevallereau, and C.-L. Shih, β€œChoice of output fortime-variant walking control for a five-link underactuated planar bipedrobot,” in Proceedings of 2009 IEEE-RAS International Conference onHumanoid Robots, Paris, France, December 2009.

[15] E. Westervelt, J. Grizzle, and D. Koditschek, β€œHybrid zero dynamicsof planar biped walkers,” IEEE Transactions on Automatic Control,vol. 48, no. 1, pp. 42–56, 2003.

[16] E. Westervelt, J. Grizzle, C. Chevallereau, J. Choi, and B. Morris,Feedback Control of Dynamic Bipedal Robot Locomotion, ser. Controland Automation. Boca Raton: CRC Press, June 2007.

4088


Recommended