18
http://pic.sagepub.com/ Engineering Science Engineers, Part C: Journal of Mechanical Proceedings of the Institution of Mechanical http://pic.sagepub.com/content/215/1/27 The online version of this article can be found at: DOI: 10.1243/0954406011520490 215: 27 2001 Proceedings of the Institution of Mechanical Engineers, Part C: Journal of Mechanical Engineering Science D Akdas and G A Medrano-Cerda regulator theory Design of a stabilizing controller for a ten-degree-of-freedom bipedal robot using linear quadratic Published by: http://www.sagepublications.com On behalf of: Institution of Mechanical Engineers can be found at: Engineering Science Proceedings of the Institution of Mechanical Engineers, Part C: Journal of Mechanical Additional services and information for http://pic.sagepub.com/cgi/alerts Email Alerts: http://pic.sagepub.com/subscriptions Subscriptions: http://www.sagepub.com/journalsReprints.nav Reprints: http://www.sagepub.com/journalsPermissions.nav Permissions: http://pic.sagepub.com/content/215/1/27.refs.html Citations: What is This? - Jan 1, 2001 Version of Record >> at The University of Manchester Library on November 12, 2013 pic.sagepub.com Downloaded from at The University of Manchester Library on November 12, 2013 pic.sagepub.com Downloaded from

Design of a stabilizing controller for a ten-degree-of-freedom bipedal robot using linear quadratic regulator theory

  • Upload
    iit-it

  • View
    0

  • Download
    0

Embed Size (px)

Citation preview

http://pic.sagepub.com/Engineering Science

Engineers, Part C: Journal of Mechanical Proceedings of the Institution of Mechanical

http://pic.sagepub.com/content/215/1/27The online version of this article can be found at:

 DOI: 10.1243/0954406011520490

215: 27 2001Proceedings of the Institution of Mechanical Engineers, Part C: Journal of Mechanical Engineering Science

D Akdas and G A Medrano-Cerdaregulator theory

Design of a stabilizing controller for a ten-degree-of-freedom bipedal robot using linear quadratic  

Published by:

http://www.sagepublications.com

On behalf of: 

  Institution of Mechanical Engineers

can be found at:Engineering ScienceProceedings of the Institution of Mechanical Engineers, Part C: Journal of MechanicalAdditional services and information for

   

  http://pic.sagepub.com/cgi/alertsEmail Alerts:

 

http://pic.sagepub.com/subscriptionsSubscriptions:  

http://www.sagepub.com/journalsReprints.navReprints:  

http://www.sagepub.com/journalsPermissions.navPermissions:  

http://pic.sagepub.com/content/215/1/27.refs.htmlCitations:  

What is This? 

- Jan 1, 2001Version of Record >>

at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

Design of a stabilizing controller for aten-degree-of-freedom bipedal robot usinglinear quadratic regulator theory

D Akdas* and G A Medrano-Cerda

Department of Electronic and Electrical Engineering, University of Salford, UK

Abstract: This paper considers the design and evaluation of stabilizing controllers for a ten-degree-

of-freedom (10 DOF) biped robot using linear quadratic optimal control techniques and reduced-

order observers. The controllers are designed using approximate planar dynamical models for thesagittal and lateral planes. Experiments were carried out to test the control system when the biped

robot was in the double-support phase and the robot was subject to external disturbances. Although

the control system is based on single-support models, the experimental results have shown that the

robot successfully kept its given posture under disturbances.

Keywords: stabilizing controller, bipedal robot, linear quadratic regulator theory

1 INTRODUCTION

In recent years, there has been an increased interest in

bipedal robots. In particular, the creation of the Eur-

opean Network on Climbing and Walking Robots

(CLAWAR) has provided a focus for worldwide

research on mobile robotics. Experimental prototypes

have been developed throughout the world and, atpresent, the most remarkable results have been achieved

by Hirai et al. [1]. However, biped robots are still quite

primitive and a substantial amount of research is needed

to develop a biped capable of performing useful tasks inunstructured and hazardous environments. Some

attractive features of two-legged robots are their

potential to navigate in con® ned spaces, walk on rough

terrain and ascend/descend stairs.

One of the major problems in bipedal robots is that ofpreserving stability during locomotion as well as stati-

cally. This problem alone provides a substantial engi-

neering challenge. Hierarchical control architectures are

usually adopted to achieve stable locomotion, particu-

larly at high speeds. High-level controllers generate

suitable walking patterns according to terrain condi-

tions, speed and gait. The realization of a walking pat-tern is then the task of low-level joint controllers.

Several researchers have investigated stabilization

strategies based on modern control theory and linear-

ized (planar) models. Mita et al. [2] used linear optimal

regulator theory; Eldukhri [3] and Medrano-Cerda and

Eldukhri [4] considered linear optimal control imple-

mented via reduced-order observers. Hemami and

Wyman [5] and Golliday and Hemami [6] used pole

placement controllers in their simulation studies;decoupling control was studied by Raibert [7] and

Golliday and Hemami [8]. Comparative simulation

studies were presented in reference [9] for PD, computed

torque and sliding mode controllers. Miura and Shi-

moyama [10] used linear state feedback to stabilizemotions around carefully preselected trajectories.

An alternative approach is to use low-level servo-

controllers for each joint to track a desired trajectory.

The stabilization is then carried out entirely by high-

level controllers. Channon et al. [11] used local PD joint

controllers with gravity compensation and gain sche-

duling; slow motion stabilization was achieved by con-

trolling the position of the centre of gravity. Inaba et al.

[12] followed a similar approach for static balancing

using vision feedback to control the centre of gravity

position. Strategies using neural networks have been

suggested by Fukuda et al. [13], Kun and Miller [14] and

Salatian and Zheng [15]. For high-speed locomotion, the

problem of maintaining balance involves controlling the

position of the zero moment point (ZMP) [16]. TheZMP method has been frequently used in biped robot

stabilization. For a biped with a trunk, the outline of the

method is as follows [17, 18]:

1. For a chosen terrain, the leg trajectories and desired

ZMP trajectory are speci® ed.

The MS was received on 20 September 1999 and was accepted afterrevision for publication on 21 March 2000.* Corresponding author: Department of Electron and ElectricalEngineering, University of Salford, Salford M5 4WT, UK.

27

C12899 ß IMechE 2001 Proc Instn Mech Engrs Vol 215 Part C at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

2. The trunk motion stabilizing the robot for the

chosen trajectories is determined.3. The trajectories in 1 and 2 are used as reference

inputs for the local joint servos.

Since the stabilizing trunk motion is computed using

mathematical models, there will be discrepancies

between the desired ZMP and the actual ZMP trajec-tories. For large errors, locomotion stability cannot be

guaranteed. Li et al. [19] considered using measure-

ments of the actual ZMP to modify the trunk motion

so that ZMP errors become small. Re® nements and

variations to the basic ZMP approach have been

investigated in recent years. Yamaguchi et al. [20] useda three degree-of-freedom (3 DOF) trunk to stabilize a

biped robot. An adaptive controller that modi® es the

initial leg trajectories using information about the foot

landing surface was proposed by Yamaguchi et al. [21].

The ZMP approach has also been extended to bipedrobots with arms. [22] The humanoid robot developed

by Hirai et al. [1] is also based on the ZMP method,

but a slightly diŒerent scheme to the one described

above is used. The authors claim that their posture-

stabilizing controller is similar to that of humans, yetwhen walking or standing on ¯ at surfaces the angles in

the sagittal plane are rather large. This is particularly

noticeable in the knee joints. The magnitudes of these

angles could be reduced by specifying a slightly

diŒerent walking pattern. For small sagittal angles the

eŒects of backlash can become a problem, but a suit-

ably designed joint control system should overcome

this di� culty. It is believed that the performance of local

PD joint controllers can be greatly improved by more

sophisticated low-level controllers (see also reference

[9]). In previous research [3, 4] the present authors have

designed and tested joint controllers for locomotion in

the sagittal plane on ¯ at surfaces. Results showed that

during the single-support phase the leg joints could be

straightened and, while standing on both feet, small

angles could be maintained to reduce power consump-

tion. The ® rst prototype had eight degrees of freedom,

seven in the sagittal plane and one in the lateral plane

(trunk). This joint distribution limited the robot loco-

motion to the sagittal plane. Additional degrees of

freedom were needed for locomotion in the lateral plane.

Therefore, two more degrees of freedom have been

inserted in the lateral plane. The work in this paper is an

extension of previous research to include multiple

degrees of freedom in both sagittal and lateral planes.

To simplify the design, independent stabilizing con-

trollers are developed for the sagittal and lateral planes.

A brief description of the new biped robot is given in

Section 2. The technique used for derivation of mathe-

matical models and the designs of the control systems

are presented in Section 3. The robustness and dis-

turbance transmission properties of the control systems

are assessed in Section 4. Experimental results are given

in Section 5. Conclusions and further work are sum-

marized in Section 6.

Fig. 1 Lateral and sagittal joints of the biped robot

28 D AKDAS AND G A MEDRANO-CERDA

Proc Instn Mech Engrs Vol 215 Part C C12899 ß IMechE 2001 at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

2 SYSTEM DESCRIPTION

The new bipedal robot has ten degrees of freedom, threeof them in the lateral plane and seven in the sagittal

plane. Figure 1 shows the joint distribution. The joints

are driven by permanent magnet d.c. motors and higher-

quality gearboxes (higher e� ciency and smaller back-

lash). Potentiometers are used to measure the relative

joint angles. The robot weighs about 13 kg and is 160 cm

tall. The foot size is 12 cm by 22 cm. The biped is con-trolled by a 486DX20 PC. Smoothing and anti-aliasing

® lters (at 15 and 22 Hz respectively) are used to condi-

tion the signals. The new robot is the second-generation

bipedal robot built at the University of Salford. Themajor modi® cations that were carried out to the ® rst

prototype are:

1. Two hip joints were added in the lateral plane. Both

joints are driven by 90 W d.c. motors and worm-

wheel gearboxes with low backlash (less than

0.02 rad). This has increased the mass of the hipby approximately 3 kg.

2. The trunk gearboxes were replaced with worm-

wheel gearboxes (low backlash). Also, 70 W d.c.

motors are used in the new trunk drives.3. The drives for the knee and hip joints in the sagittal

plane were changed. The new drives use 20 W d.c.

motors. The new gearboxes have larger reduction

ratios than those used in the ® rst prototype [3, 4].

These changes have increased the overall gain of the

drive as well as the contributions of motor inertia

and damping re¯ ected at the output shaft.

Parameter values for the new robot are included in the

Appendix.

3 MATHEMATICAL MODELLING AND

CONTROL SYSTEM DESIGN

Symbolic mathematical models of the biped are

obtained for the sagittal and lateral planes separately. In

this way, the complexity of the symbolic model is

reduced. Kane’s equations of motion have been used to

obtain the corresponding dynamic models assuming anopen-chain structure and that the robot is in the single-

support phase [23]. It is also assumed that the support

foot is in ® rm contact with the ground and slippage does

not occur. Reduced-order models for the double-

support phase (closed-chain structure) are derived byincluding the forces of constraint in the dynamic equa-

tions [5, 23, 24]. In this paper, stabilizing control systems

are designed using linearized single-support models.

However, the control systems should be su� ciently

robust to stabilize linearized models in the double-sup-port phase.

3.1 Mathematical model for the sagittal plane

The general form of the equation for a multi-body sys-

tem is

A ³… † �³ ‡ B ³; _³ _³ ˆ f ‡ CT…³†K

W…³† ˆ 0

…1†

where A and B are n £ n matrices, A…³† is the inertia

tensor matrix, B…³; _³ † _³ is the vector of centripetal and

Coriolis forces. The r £ 1 vector W…³† denotes holo-

nomic constraints and C…³† ˆ @W=@³ is an r £ n matrix

[the Jacobian of W…³†Š, f is an n £ 1 generalized force

vector including eŒects of gravity and input forces andK is an r £ 1 vector denoting forces of constraint. In the

sagittal plane, n ˆ 7 (the number of degrees of freedom)

and r ˆ 2; ³, _³ and �³ denote the relative joint angles,

relative angular velocities and accelerations respec-

tively.

When the biped is in the single-support phase, K ˆ 0.Linearizing (1) around the upright position …³ ˆ _³ ˆ 0†yields a 14-dimensional linear state-space model. This

model, including d.c. motors and gearboxes, can be

written in terms of the state variables of the ® rst six linksand the states of the seventh link (see Fig. 1) as

_x6 ˆ A6x6 ‡ B6u6 ‡ A67x7 ‡ B6

7u7

_x7 ˆ A7x7 ‡ B7u7 ‡ A76x6 ‡ B7

6u6

Taking norms gives

_x6k k4 A6k k x6k k ‡ B6k k u6k k ‡ A67 x7k k ‡ B6

7 u7k k

_x7k k4 A7k k x7k k ‡ B7k k u7k k ‡ A76 x6k k ‡ B7

6 u6k k

where

A6k k ˆ 250:33; B6k k ˆ 22:19

A67 ˆ 18:94; B6

7 ˆ 1:91

A7k k ˆ 202:96; B7k k ˆ 20:42

A76 ˆ 54:31; B7

6 ˆ 2:66

The above results indicate that the contributions of x7

and u7 (the ankle joint) to _x6 are not too large. There-

fore, in order to reduce complexity in the calculations of

the controller, this joint is neglected in the derivation of

the mathematical model in the sagittal plane. However,

the mass of the swing-leg foot is added to the mass of thecorresponding knee link. To keep the swing-leg foot

DESIGN FOR A STABILIZING CONTROLLER FOR A 10 DOF BIPEDAL ROBOT 29

C12899 ß IMechE 2001 Proc Instn Mech Engrs Vol 215 Part C at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

parallel to the ground, a separate foot controller has

been designed.Neglecting the ankle joint, there are six degrees of

freedom (i.e. n ˆ 6). Linearizing (1) around the upright

position and using a 10 ms sampling time interval, a

linear discrete time model is obtained in state-space

form:

xs…k ‡ 1† ˆ Asxs…k† ‡ Bsus…k† ‡ Bdists ½½½½½s…k†

xs1…k† ˆ Csxs…k†

xs ˆ xTs1 xT

s2

T

…2†

where As, Bs, Bdists and Cs are the state-space matrices in

the sagittal plane. The numerical values for the linearcontinuous time model are given in the Appendix. The

control signal is denoted by us , xs1 represents relative

angular displacements, xs2 represents relative angular

velocities and ½½½½½s represents torque disturbances. This

model included the motor and gearbox parameters (see

the Appendix).During the double-support phase, the ground reaction

forces ¤ are not zero. In this case, the number of

independent degrees of freedom is reduced. The motion

of the biped is then restricted to submanifolds of the

state space of dimension 2…n ¡ r† satisfying the con-straint equation W…³† ˆ 0. The linearized models for the

constrained equations of motion have the same number

of unstable eigenvalues as the model in the single-sup-

port phase. However, the double-support models are not

controllable. Reduced-order controllable models areobtained by removing the uncontrollable states [5, 24].

The reduced-order models still have the same number of

unstable eigenvalues as the single-support model. The

equations of constraint W…³† are given in the Appendix.

The control system in the sagittal plane is designed

using the single-support model (2). Once this controlleris obtained, the stability and performance of the closed-

loop system can be evaluated using the model in the

double-support phase.

3.2 Mathematical model for the lateral plane

The mathematical model for the lateral plane has been

derived in the same way as for the sagittal plane, buthere only three links (hip, trunk and swing leg) are

considered, i.e. n ˆ 3 in equation (1). The model is lin-

earized about the vertical except for the hip link, which

is linearized about the horizontal. The support leg is

assumed to maintain a vertical position despite motionsof other links. Since the biped does not have a lateral

ankle actuator (nor a sensor), this assumption is only

valid in some special cases:

1. The foot width is large enough for the ground

reaction forces to counteract the lateral disturbance

torque produced by gravity.

2. The foot of the support leg is clamped to the ground

so that the robot cannot overturn sideways.3. The biped is mostly in the double-support phase,

and the single-support phase occurs in a short time

interval.

In this paper only case 3 is considered. This is su� cient

for experimental evaluation of the proposed controllerdesign in terms of independent controllers for each plane

of motion. Inclusion of lateral ankle joints would avoid

this restriction.

The linear discrete time model for the lateral plane

(including motors and gearboxes) is given by

xl…k ‡ 1† ˆ Alxl…k† ‡ Blul…k† ‡ Bdistl ½½½½½l…k†

xl1…k† ˆ Clxl…k†

xl ˆ xTl1 xT

l2

T

…3†

where Al, Bl, Bdistl and Cl are the state-space matrices in

the lateral plane. The torque disturbance produced by

gravity in the lateral plane is ½½½½½l ˆ ¡12:23 0 0‰ ŠT. Thenumerical values for the linear continuous time model

are given in the Appendix. The derivation of double-

support, reduced-order models for the lateral plane is

similar to the computations in the sagittal plane.

The control system in the lateral plane is designed

using model (3). Once this controller is obtained, thestability and performance of the closed-loop system can

be evaluated using the model in the double-support

phase.

3.3 Observer design

The present control system involves state feedback.

Since only relative angles are measured, the corre-

sponding relative angular velocities need to be esti-mated. To achieve this, reduced-order observers are

used. Both models are observable, and this ensures that

state observers with arbitrarily chosen dynamics can be

designed. The structure of the observer is given below

for the sagittal plane:

zs…k† ˆ Fszs…k† ‡ Esxs1…k† ‡ Hsus…k†

x̂s2…k† ˆ zs…k† ‡ Ksxs1…k†

…4†

30 D AKDAS AND G A MEDRANO-CERDA

Proc Instn Mech Engrs Vol 215 Part C C12899 ß IMechE 2001 at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

where zs is the state vector of the observer and x̂s2 is the

vector of estimated relative angular velocities in thesagittal plane. The torque disturbances are excluded in

the observer since they are not measured or known

accurately. In some cases, simple disturbances could be

modelled (e.g. the eŒect of the umbilical cable), but in

general it is unrealistic to try to model every possible

disturbance. Neglecting the disturbances in the design ofthe observer produces errors in the estimated angular

velocities. It is possible to design reduced-order obser-

vers that are independent of the plant disturbances, but

then the observer eigenvalues cannot be chosen arbi-

trarily. In fact, some or all of the eigenvalues of Fs haveto be chosen at the locations of the stable invariant zeros

[25]. In addition, since observers are highly sensitive to

variations in plant parameters, even an observer that is

independent of the disturbances would fail to provide

asymptotic state reconstruction. Techniques for redu-cing observer estimation errors due to plant parameter

changes are available [26] or, alternatively, adaptive

observers could be used [27]. In spite of state estimation

errors, the performance of an observer-based controller

can exhibit a good degree of robustness with respect to

plant parameter variations. This paper does not considerthe design of an observer with minimum estimation

errors but rather focuses on obtaining a robust observer-

based controller. Re® nements on observer design will be

considered elsewhere.

In this work, the observer design is based on a simplertechnique compared with the approach used in refer-

ences [3] and [4]. Here, the observer state matrix Fs has

been chosen, and the remaining observer parameters are

computed from the following relations [28]:

As ˆAs11 As12

As21 As22

; Bs ˆBs1

Bs2

Ks ˆ As22 ¡ Fs… †A¡1s12

Hs ˆ Bs2 ¡ KsBs1

Es ˆ As21 ¡ KsAs11… † ‡ FsKs

The observer should drive the estimation error close tozero quickly, but without degrading stability margins

too much. The matrix Fs ˆ 0:9I6£6 has been chosen,

where I6£6 is a 6 by 6 identity matrix. This selection is a

compromise between the speed of response of the

observer and a reduction in relative stability. In general,

as the eigenvalues of Fs approach zero, the observerbecomes a `diŒerentiator’ , relative stability decreases

and quantization noise is substantially ampli® ed. The

observer for the lateral plane has the same structure as

the one given above for the sagittal plane.

3.4 Control system for the sagittal plane

The control system consists of three independent con-

trollers. The ® rst two controllers stabilize the robot in

the sagittal and lateral planes. The third one is a pro-portional controller for the foot of the swing leg in the

sagittal plane (see Fig. 2). The stabilizing control sys-

tems incorporate state feedback (reduced-order obser-

vers are used to estimate the relative angular velocities),

integral action to reduce the steady state errors and afeedforward term to speed up tracking of reference sig-

nals. Therefore, the structure of the control system is

us…k† ˆ ¡L2sxas…k† ¡ L11

s xs1…k† ¡ L12s x̂s2…k† ‡ Lff

s rs…k†

…5†

where L11s is the gain associated with the relative angles,

L12s is for the relative angular velocities and L2

s is for the

integral action. The feedforward gain Lffs is set equal to

L11s .

Fig. 2 Observer-based control system for the sagittal plane

DESIGN FOR A STABILIZING CONTROLLER FOR A 10 DOF BIPEDAL ROBOT 31

C12899 ß IMechE 2001 Proc Instn Mech Engrs Vol 215 Part C at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

The state-space representation of the integral action is

xas…k ‡ 1† ˆ ©asxas…k† ‡ ¡asuas…k†

uas…k† ˆ rs…k† ¡ xs1…k†

…6†

where xas is the state vector for the integrators, rs is the

vector of reference signals, which is set to zero in the

linear quadratic regulator design, ©as and ¡as are 6 £ 6identity matrices and xas, rs and xs1 are 6 £ 1 vectors.

The design of the optimal state feedback matrix starts

with the speci® cation of a quadratic performance index

J and the constraint equation. The objective is to

minimize J around the nominal operating point. The

performance index is in the form

Js ˆ1

kˆ0

xds…k†TQdsxds…k† ‡ us…k†TRdsus…k† …7†

where Qds and Rds are chosen as diagonal matrices with

positive entries. The constraint equation (ignoring tor-

que disturbances) is

xds…k ‡ 1† ˆ ©dsxds…k† ‡ ¡dsus…k† …8†

where

xds ˆxs

xas

©ds ˆAs 012£12

¡¡asCs ©as

¡ds ˆBs

06£6

The selection of Qds and Rds was investigated in Matlab

simulations and during experiments. The aims were to

achieve fast response with little or no overshoot and tomaintain the control signal within the power supply

limitations. The chosen values for Qds and Rds are

Qds ˆ Qsp Qsv Qsu

Qsp ˆ diag105 7 £ 104 5 £ 104

4 £ 105 3 £ 104 3 £ 104

Qsv ˆ 06£6

Qsu ˆ 10¡3I6£6

Rds ˆ I6£6

…9†

where Qsp is the matrix penalizing angular positions,

Qsv is for the velocities and Qsu is for the integralactions. In selecting Qsp, it was desirable for them to

be as low as possible to prevent demands for large

control actions. Low Qsp values increase relative sta-

bility and reduce sensitivity to noise. However, to

track reference signals with small errors and quickly

attenuate torque disturbances, relatively high values ofQsp are needed. Therefore, a compromise was made

between relative stability margins and the good

tracking of reference signals.

In order to minimize the control eŒorts, the matrix

penalizing velocities, Qsv, is set to zero. In the sagittalplane, gains for integral actions were kept to a mini-

mum. High integral gains tend to cause oscillations in

the system, mainly owing to the presence of backlash.

At present, tuning of the individual entries in Rds has

not been considered. One alternative would be to chooseRds taking into account the power of each actuator.

Once Qds and Rds are chosen, the optimal value J ¤s of

(7) is given in terms of the initial condition xs…0† and the

solution of the corresponding discrete-time algebraic

Riccati equation, P rics , i.e. J ¤

s ˆ xTs …0†P ric

s xs…0†.

3.5 Control system for the lateral plane

The control system has the same structure as the one for

the sagittal plane. The only diŒerence is that in the lat-

eral plane there are three links instead of six. The

matrices Qdl and Rdl for the performance index are

Qdl ˆ …Qlp†3£3 …Qlv†3£3 …Qlu†3£3

Qdl ˆ diag 104 104 104 0 0 0 1 1 19£9

Rdl ˆ I3£3

Owing to high static friction of the worm gearboxes used

for the lateral hip joints, the integral penalty matrix Qlu

is given higher values than those in the sagittal plane.

Bear in mind that excessive integral gain can causeoscillations.

4 RELATIVE STABILITY AND PERFORMANCE

This section investigates the robustness of the control

system through the analysis of Nyquist and singular-value plots. The state-space representation of the overall

32 D AKDAS AND G A MEDRANO-CERDA

Proc Instn Mech Engrs Vol 215 Part C C12899 ß IMechE 2001 at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

controller can be written as follows (subscript s is used

for the sagittal plane and l for the lateral plane):

~as ˆFs ¡ HsL12

s ¡HsL2s

0 ©as

~bs ˆEs ¡ Hs L11

s ‡ L12s Ks

¡¡as

~cs ˆ ¡ L12s L2

s ; ~ds ˆ ¡ L11s ‡ L12

s Ks

~gs ˆHsL11

s

¡as

…10†De® ning

Gcs z… † ˆ ~cs zI ¡ ~as… †¡1 ~bs ‡ ~ds

Ns z… † ˆ ~cs zI ¡ ~as… †¡1 ~gs ‡ L11s

Gs…z† ˆ Cs…zI ¡ As†¡1Bs

Gdists …z† ˆ Cs…zI ¡ As†¡1Bdist

s

…11†Then, equations (2) and (5) can be written as

xs1 z… † ˆ Gs…z†u z… † ‡ Gdists ½½½½½s z… †

us z… † ˆ Gcs…z†‰xs1 z… † ‡ ns…z†Š ‡ Ns…z†rs z… †

…12†where, ns represents the quantization measurement

noise. The tilde in equations (10) and (11) is used toavoid using the same symbols to represent diŒerent

matrices or vectors. The corresponding block diagram is

shown in Fig. 3, where ds represents contributions from

torque disturbances. The pre® lter Ps z… † can be used to

limit angular velocities, to reduce large sudden demandsin the control signals or to carry out smooth transitions

between diŒerent reference set-points.

The design of the control system does not include the

eŒects of the smoothing ® lters (at 15 Hz) and the anti-

aliasing ® lters (at 22 Hz). However, their eŒects on the

robustness of the control system are investigatedthrough Nyquist plots of the determinant of return

diŒerence matrices. The return diŒerence equations at

the plant input and output are given below.

For the sagittal plane

Fos z… † ˆ I ¡ Gs z… †Gcs z… †

Fis z… † ˆ I ¡ Gcs z… †Gs z… †

…13†

The control system shown in Fig. 3 can be expressed as

yms z… † ˆ Sos z… †ds z… † ‡ Gys z… †yrs z… † ‡ Tos z… †ns z… † …14†

us z… † ˆ Gus z… †yrs z… † ‡ Tis z… † ds z… † ‡ ns z… †… † …15†

Sos z… † ˆ Fos z… †¡1; Sis z… † ˆ Fis z… †¡1

Gys z… † ˆ Sos z… †Gs z… †Ns z… †Ps z… †

Tos z… † ˆ Sos z… †Gs z… †Gcs z… †

Gus z… † ˆ Sis z… †Ns z… †Ps z… †; Tis z… † ˆ Sis z… †Gcs z… †

The above analysis can be carried out for the planttogether with the smoothing and anti-aliasing ® lters, i.e.

Gs z… † is replaced with Gfs z… † after appending all the

relevant ® lter dynamics. For the equations in the lateral

Fig. 3 Control system block diagram (drawn for the sagittal plane)

DESIGN FOR A STABILIZING CONTROLLER FOR A 10 DOF BIPEDAL ROBOT 33

C12899 ß IMechE 2001 Proc Instn Mech Engrs Vol 215 Part C at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

plane, the subscript s is replaced by l. General infor-

mation about singular-value analysis can be found inreferences [29] and [30].

Figure 4 shows the Nyquist plots of det…Fos† and

det…Fol† around the critical point [note that det…Fos† ˆdet…Fis†Š. For the sagittal plane, the origin is encircled

four times in an anticlockwise direction. For the lateral

plane, three encirclements of the origin occur. Note thatthe number of encirclements is equal to the number of

unstable open-loop eigenvalues of each model (sagittal

or lateral plane) provided that the controller (10) has no

eigenvalues outside the unit circle. The Nyquist plots

clearly indicate that the anti-aliasing and smoothing® lters have reduced the relative stability of the control

system.

Figures 5 to 8 show the singular-value plots of the

transfer matrices given by equations (14) and (15) with

and without the ® lters. Again, the analysis with nominaldesign has better gain characteristics.

Figure 5 shows the transmission from output dis-

turbance to the plant output in the sagittal and lateral

planes (output sensitivity function). In the sagittal

plane, the plot shows that, up to 0.8 Hz, any outputdisturbances are attenuated by the control system.

However, above 0.8 Hz, disturbances can be ampli® ed,

especially around 8 Hz. Also, the analysis with the

® lters shows degradation in performance. In the lateral

plane, the system is susceptible to disturbances above

0.8 Hz.Figure 6 shows the transmission of reference signals at

the plant output for the sagittal and lateral planes

respectively (cut-oŒfrequencies of about 1 and 1.5 Hz).

Both analyses are shown without pre® lters. Step refer-

ence signals can produce angular velocities in excess of1 rad/s. For such speeds, the linearized model will be less

accurate than the non-linear model (1) owing to terms

involving squared angular velocities. Therefore, in the

experimental evaluation, use has been made of unity

gain pre® lters (about 0.16 Hz bandwidth) to keepangular velocities smaller than 1 rad/s.

Noise transmission characteristics at the plant output

are given in Fig. 7 for both planes. In the sagittal

Fig. 4 Nyquist plots of det…Fos† and det…Fol† in the sagittal

and lateral planes

Fig. 5 Singular-value plots of the sensitivity matrices in the

sagittal plane ‰Sos…z† and Sofs…z†Š and the lateral plane

‰Sol…z† and Sofl…z†Š at the plant output

34 D AKDAS AND G A MEDRANO-CERDA

Proc Instn Mech Engrs Vol 215 Part C C12899 ß IMechE 2001 at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

plane, measurement noise begins to be attenuatedabove 8 Hz. In the lateral plane the performance isslightly better, and noise attenuation occurs above4 Hz. Sources of noise are due to quantization errors ofabout §0:5 mrad.

The contributions of disturbances and noise to thecontrol eŒort are presented in Figure 8 for the sagittaland the lateral plane. The experimental data gatheredfrom joint positions indicated that quantization is themain source for noise, and its amplitude is §0:5 mrad.Maximum ampli® cation in the sagittal plane is 56 dB(Fig. 8). This may produce a control eŒort of around0.31 V. This voltage level is not large enough to driveany joints, since a voltage of around 0.5 V is needed toovercome stiction. Therefore, the control eŒorts arenot signi® cantly contaminated by quantization noise.The analysis carried out above was based on single-support models. A similar analysis can be carried out

using double-support models, i.e. the plant is replaced

with a double-support model. It has been veri® ed in

simulations that the resulting closed-loop system

remains stable. Details of this analysis are omitted in

this paper.

5 EXPERIMENTAL RESULTS

In the experiments, only maintaining a given posturewhile the biped is in the double-support phase wasconsidered. The reference angles for the joints (exceptthe lateral trunk) are given in Table 1. These anglescorrespond to a standing position while moving thetrunk in the lateral plane. The reference angles satisfythe constraint equations and keep the feet 0.05 m apart.

Fig. 6 Singular-value plots of the transfer matrices in the

sagittal plane ‰Gys…z† and Gyfs…z†Š and the lateral plane

‰Gyl…z† and Gyfl…z†Š at the plant output

Fig. 7 Singular-value plots of the complementary sensitivity

matrices in the sagittal plane ‰Tos…z† and Tofs…z†Š and

the lateral plane ‰Tol…z† and Tofl…z†Š at the plant output

DESIGN FOR A STABILIZING CONTROLLER FOR A 10 DOF BIPEDAL ROBOT 35

C12899 ß IMechE 2001 Proc Instn Mech Engrs Vol 215 Part C at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

Stick diagrams of the reference robot posture are shown

in Fig. 9. Experimental results are shown in Figs 10 to

12. These results show that the stabilizing controllers

successfully kept the links close to the reference posi-

tions even under small disturbances produced by the

trunk motion. Figures 10 and 11 show the eŒects of

lateral trunk motion on the sagittal plane joints. It can

be clearly seen that all the deviations are well within the

backlash region, which is §0:05 rad.

In Fig. 12, lateral plane joints and the correspond-

ing control signals are shown. The lateral plane trunk

motion exhibits small tracking errors. Their most

likely source is non-linear friction in the gearbox. The

other joints in the lateral plane show small deviations

from their references, in spite of the disturbance

caused by the trunk in the same plane. There are two

likely explanations for this immunity to disturbance.

The ® rst one is that gearboxes in the lateral plane hip

joints are not back-drivable, and the second reason isthat they have quite small backlash levels. However,

they have larger stiction, and this can aŒect transient

response.

Fig. 8 Singular-value plots of transfer matrices in the sagittal

plane ‰Tis…z† and Tifs…z†Š and the lateral plane ‰Til…z†and Tifl…z†Š at the plant input

Table 1 Biped robot double-support

reference angles

Saggital support ankle ¡0:1967Sagittal support knee ¡0:0508Saggital support hip 0.1503Saggital trunk 0.0045Saggital swing hip ¡0:3173Saggital swing knee ¡0:0838Saggital swing ankle 0.2894Lateral support hip 0.0721Lateral trunk ChangingLateral swing hip ¡0:0486

Fig. 9 Reference posture of the biped robot during the experiment: (a) side view (sagittal plane joints are

marked); (b) front view (lateral plane joints are marked)

36 D AKDAS AND G A MEDRANO-CERDA

Proc Instn Mech Engrs Vol 215 Part C C12899 ß IMechE 2001 at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

The control signals for the sagittal and lateral plane

joints are desirably low. Table 1 shows the reference

angles that were used during the experiment.

6 CONCLUSIONS AND FURTHER WORK

This paper has presented an approach for stabilization

of a 10 DOF biped robot using LQR theory andreduced-order observers. The theoretical analysis and

the experimental results have shown that the technique

is robust against disturbances or noise. The control

systems were designed using single-support models, andthis work has shown that the controllers worked well in

the double-support phase. At present, the 10 DOF biped

robot is incapable of static single support and the design

technique has yet to be experimentally validated in the

single-support phase. Current work involves adding two

powered DOF in the lateral plane (lateral ankle motionsand torques). This would allow static single-support

Fig. 10 Saggital plane support-leg knee, trunk and swing-leg knee orientations and control eŒorts

DESIGN FOR A STABILIZING CONTROLLER FOR A 10 DOF BIPEDAL ROBOT 37

C12899 ß IMechE 2001 Proc Instn Mech Engrs Vol 215 Part C at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

Fig. 11 Saggital plane support-leg ankle and hip and swing-leg ankle and hip orientations and control eŒorts

38 D AKDAS AND G A MEDRANO-CERDA

Proc Instn Mech Engrs Vol 215 Part C C12899 ß IMechE 2001 at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

Fig. 12 Lateral plane joint orientations and control eŒorts

DESIGN FOR A STABILIZING CONTROLLER FOR A 10 DOF BIPEDAL ROBOT 39

C12899 ß IMechE 2001 Proc Instn Mech Engrs Vol 215 Part C at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

balance and give the robot the capability to climb stairs

and walk at low speeds, as well as making dynamicwalking smoother. In addition, the control system was

capable of maintaining joint positions close to given

reference values under small torque disturbances. For

large torque disturbances the biped did not remain

standing. This failure was due to the lack of information

about ground reaction forces. It is clear that groundreaction force measurements are essential to maintain

equilibrium in realistic situations.

REFERENCES

1 Hirai, K., Hirose, M., Haikawa, Y. and Takenaka, T. The

development of Honda humanoid robot. In IEEE Inter-

national Conference on Robotics and Automation, Leuven,

Belgium, May 1998, Vol. 2, pp. 1321± 1326.

2 Mita, T., Yamaguchi, T., Kashiwase, T. and Kawase, T.

Realization of a high speed biped using modern control

theory. Int. J. Control, 1984, 40(1), 107± 119.

3 Eldukhri, E. E. Design and control of a biped walking

robot. PhD thesis, Department of Electronic and Electrical

Engineering, University of Salford, UK.

4 Medrano-Cerda, G. A. and Eldukhri, E. E. Biped robot

locomotion in the sagittal plane. Trans. Inst. Measmt and

Control, 1997, 19(1), 38± 49.

5 Hemami, H. and Wyman, B. F. Modeling and control of

constrained dynamic systems with application to biped

locomotion in the frontal plane. IEEE Trans. Autom.

Control, 1979, AC-24(4), 527± 535.

6 Golliday Jr, C. L. and Hemami, H. Postural stability of the

two-degree of freedom biped by general linear feedback.

IEEE Trans. Autom. Control, 1976, AC-21(1), 74± 79.

7 Raibert, M. H. Legged Robots that Balance, 1986 (MIT

Press, Cambridge, Massachusetts).

8 Golliday Jr, C. L. and Hemami, H. An approach to

analyzing biped locomotion dynamics and designing robot

locomotion controls. IEEE Trans. Autom. Control, 1977,

AC-22(6), 963± 972.

9 Raibert, M. H., Tzafestas, S. and Tzafestas, C. Compara-

tive simulation study of three control techniques applied to

a biped robot. In IEEE International Conference on

Systems, Man and Cybernetics, Le Touquet, France,

October 1993, Vol. 1, pp. 494± 502.

10 Miura, H. and Shimoyama, I. Dynamic walk of a robot.

Int. J. Robotics Res., 1984, 3(2), 60± 74.

11 Channon, P. H., Hopkins, S. H. and Pham, D. T.

Modelling and control of a bipedal robot. J. Syst.

Engng, 1992, 2, 46± 59.

12 Inaba, M., Kanehiro, F., Kagami, S. and Inoue, H. Two-

armed bipedal robot that can walk, roll over and stand up.

In IROS’95 International Conference on Intelligent Robots

and System, Pittsburgh, Pennsylvania, 1995, Vol. 3, pp.

297± 302.

13 Fukuda, T., Komata, Y. and Arakawa, T. Stabilisation

control of biped locomotion robot based learning with Gas

having self-adaptive mutation and recurrent neural net-

works. In IEEE International Conference on Robotics and

Automation, Albuquerque, New Mexico, April 1997, Vol.

1, pp. 217± 222.

14 Kun, A. and Miller, W. T. Adaptive dynamic balance of a

biped robot using neural networks. In IEEE International

Conference on Robotics and Automation, Minneapolis,

Minnesota, April 1996, pp. 240± 245.

15 Salatian, A. W. and Zheng, Y. F. Gait synthesis for a biped

robot climbing sloping surfaces using neural networks. In

IEEE International Conference on Robotics and Auto-

mation, Nice, France, May 1992, pp. 2601± 2606.

16 Vukobratovic, M., Borovac, B., Surla, D. and Stokic, D.

Biped Locomotion: Dynamics, Stability, Control and

Application, 1990 (Springer-Verlag, Berlin).

17 Takanishi, A., Ishida, M., Yamazaki, Y. and Kato, I. The

realization of dynamic walking by the biped walking robot

WL-10RD. In International Conference on Advanced

Robotics, Tokyo, 1985, pp. 459± 466.

18 Takanishi, A., Tochizawa, M., Takeya, T., Kanaki, H. and

Kato, I. Realization of dynamic biped walking stabilized

with trunk motion under known external force. In 4th

International Conference on Advanced Robotics, Colum-

bus, Ohio, 1990; in ScientiWc Fundamentals of Robotics 7

(Ed. K. J. Waldron), 1990, pp. 299± 310 (Springer-Verlag,

Berlin).

19 Li, Q., Takanishi, A. and Kato, I. Learning control for a

biped walking robot with a trunk. In IEEE International

Conference on Intelligent Robots and Systems, Yokohama,

Japan, July 1993, pp. 1171± 1777.

20 Yamaguchi, J., Takanishi, A. and Kato, I. Development of

a biped walking robot compensating for three-axis

moment by trunk motion. In IEEE International Con-

ference on Robotics and Automation, Yokohama, Japan,

July 1993, pp. 561-566.

21 Yamaguchi, J., Kinoshita, N., Takanishi A. and Kato, I.

Development of a dynamic biped walking system for

humanoid: development of a biped walking robot adapting

to the humans’ living ¯ oor. In IEEE International

Conference on Robotics and Automation, Minneapolis,

Minnesota, April 1996, pp. 232± 239.

22 Yamaguchi, J., Soga, E., Inoue, S. and Takanishi, A.

Developmentof a bipedal humanoid robot: control method

of whole body co-operative dynamic biped walking.

In IEEE International Conference on Robotics and

Automation, Detroit, Michigan, May 1999, pp. 368-374.

23 Amirouche, F. M. L. Computational Methods in Multibody

Dynamics, 1992 (Prentice-Hall, Englewood CliŒs, New

Jersey).

24 Shih, C. L. and Gruver, W. A. Control of a biped robot in

the double-support phase. IEEE Trans. Syst. Man and

Cybernetics, 1992, SMC-22(4), 729± 735.

25 Kudva, P., Viswanadham, N. and Ramakrishna, A.

Observers for linear systems with unknown inputs. IEEE

Trans. Autom. Control, 1980, AC-25(1), 113± 115.

26 Wang, S. D., Kuo, T. S. and Hsu, C. F. Optimal observer

design for linear dynamical systems with uncertain

parameters. Int. J. Control, 1987, 45(2), 701± 711.

27 O’Reilly, J. Observers for Linear Systems, 1983 (Academic

Press, London).

28 Vaccaro, R. J. Digital Control, a State-Space Approach,

1995 (McGraw-Hill, Singapore).

29 Maciejowski, J. M. Multivariable Feedback Design, 1989

(Addison-Wesley, Cornwall).

30 Skogestad, S. and Postlethwaite, I. Multivariable Feedback

Control (John Wiley, Chichester).

40 D AKDAS AND G A MEDRANO-CERDA

Proc Instn Mech Engrs Vol 215 Part C C12899 ß IMechE 2001 at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

APPENDIX

Planar model parameters for a 10 DOF biped

Sagittal plane

Lower leg Upper leg Hip

m1 ˆ 0:8860 kg m2 ˆ 1:1380 kg m3 ˆ 6:6800 kg

a1 ˆ 0:1550 m a2 ˆ 0:1714 m a3 ˆ 0:2189 mI1 ˆ 0:0161 kg m2 I2 ˆ 0:0227 kg m2 I3 ˆ 0:1284 kg m2

l1 ˆ 0:310 m l2 ˆ 0:356m l3 ˆ 0:405m

Trunk Upper swing leg Lower swing leg 1 foot

m4 ˆ 0:6860 kg m5 ˆ 1:1380 kg m6 ˆ 1:3770 kg

a4 ˆ 0:2439 m b5 ˆ 0:1846 m b6 ˆ 0:2281 mI4 ˆ 0:0107 kg m2 I5 ˆ 0:0227 kg m2 I6 ˆ 0:0294 kg m2

Ð l5 ˆ 0:356m Ð

Ankle drive Knee drive Hip drive

Jm1 ˆ 0:2385kg m2 Jm2 ˆ 0:6200 kg m2 Jm3 ˆ 1:0349 kg m2

cm1 ˆ 51:4555 N m s cm2 ˆ 133:7657 N m s cm3 ˆ 223:2801 N m skm1 ˆ 5:1846 N m/V km2 ˆ 7:7392 N m/V km3 ˆ 9:9988 N m/VN1 ˆ 608:88 : 1 N2 ˆ 1060:38 : 1 N3 ˆ 1369:98 : 1

²1 ˆ 0:7 ²2 ˆ 0:6 ²3 ˆ 0:6

Trunk drive Hip drive Knee drive

Jm4 ˆ 0:0137kg m2 Jm5 ˆ 1:0349 kg m2 Jm6 ˆ 0:6200 kg m2

cm4 ˆ 2:4093 N m s cm5 ˆ 223:2801 N m s cm6 ˆ 133:7657 N m s

km4 ˆ 1:1412 N m/V km5 ˆ 9:9988 N m/V km6 ˆ 7:7392 N m/VN4 ˆ 58 : 1 N5 ˆ 1369:98 : 1 N6 ˆ 1060:38 : 1

²4 ˆ 0:6 ²5 ˆ 0:6 ²6 ˆ 0:6

Lateral plane

Hip Trunk Leg 1 foot

m2 ˆ 3:6720 kg m3 ˆ 2:0260 kg m1 ˆ m4 ˆ 3:3840 kg

a2z ˆ 0:1000 m Ð a1y ˆ a4y ˆ 0:4244 m

a2y ˆ 0:0555 m a3y ˆ 0:2513 m b1y ˆ b4y ˆ 0:4556 m

I2 ˆ 0:0316 kg m2 I3 ˆ 0:0358 kg m2 I4 ˆ 0:2972 kg m2

l2z ˆ 0:2000 m l3z ˆ 0:1000 m ÐÐ l3y ˆ 0:1040 m l1y ˆ l4y ˆ 0:8800m

Hip drive Trunk drive Hip drive

Jm2 ˆ 0:1486kg m2 Jm3 ˆ 0:0159 kg m2 Jm4 ˆ 0:1486 kg m2

cm2 ˆ 27:9021 N m s cm3 ˆ 2:8108 N m s cm4 ˆ 27:9021 N m s

km2 ˆ 3:9849 N m/V km3 ˆ 1:3314 N m/V km4 ˆ 3:9849 N m/VN2 ˆ 180 : 1 N3 ˆ 58 : 1 N4 ˆ 180 : 1

²2 ˆ 0:7 ²3 ˆ 0:7 ²4 ˆ 0:7

Motor/gearbox modelling

The driving torque applied at the output shaft of the i th gearbox is given by

½i ˆ kmi ui ¡ cmi _¬i ¡ Jmi �¬i

where _¬i and �¬i are the relative angular velocity and acceleration of the i th joint, ui is the applied motor voltage, kmi is

the motor gain, cmi is the motor damping re¯ ected at the output shaft and Jmi is the motor inertia re¯ ected at theoutput shaft. In the present calculations the motor inductance and the gearbox inertia are neglected.

DESIGN FOR A STABILIZING CONTROLLER FOR A 10 DOF BIPEDAL ROBOT 41

C12899 ß IMechE 2001 Proc Instn Mech Engrs Vol 215 Part C at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

The equations of constraint in the sagittal plane are

W…³† ˆl1 sin…³1† ¡ l2 sin…³1 ‡ ³2 ‡ ³3 ¡ ³5† ‡ l2 sin…³1 ‡ ³2† ¡ l1 sin…³1 ‡ ³2 ‡ ³3 ¡ ³5 ¡ ³6†

¡l2 cos…³1 ‡ ³2 ‡ ³3 ¡ ³5† ‡ l2 cos…³1 ‡ ³2† ¡ l1 cos…³1 ‡ ³2 ‡ ³3 ¡ ³5 ¡ ³6† ‡ l1 cos…³1†

The linearized continuous time model in the sagittal plane is

cAs ˆ06£6 I6£6

As1 As2

; cBs ˆ06£6

Bs1

; cBdists ˆ

06£6

Bsd

; Cs ˆ I6£6 06£6

where

As1 ˆ

13:3876 ¡7:1781 ¡2:8624 ¡0:4062 0:1177 0:1718

¡2:0970 22:5991 3:2642 ¡0:2861 1:6529 0:3657

¡4:2989 ¡3:6545 5:2527 ¡0:2094 2:0613 0:4004

¡8:5837 ¡4:7318 16:7418 27:7846 ¡8:7234 ¡2:3441

3:2574 7:7578 8:1830 ¡0:0690 ¡5:0550 ¡1:2591

1:8170 4:0346 3:8509 ¡0:0836 ¡1:9399 ¡3:7310

As2 ˆ

¡30:3588 94:7726 4:1283 0:2662 28:8275 8:5102

36:4561 ¡165:7845 50:4770 1:1543 ¡26:2206 ¡9:1850

0:9514 30:2404 ¡153:0078 1:3691 ¡44:4223 ¡14:9545

5:6860 64:0855 126:8855 ¡43:5726 51:1982 22:4454

6:6434 ¡15:7086 ¡44:4223 0:5524 ¡165:1843 19:2464

3:2736 ¡9:1850 ¡24:9620 0:4043 32:1258 ¡196:8525

42 D AKDAS AND G A MEDRANO-CERDA

Proc Instn Mech Engrs Vol 215 Part C C12899 ß IMechE 2001 at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from

Bs1 ˆ

3:0589 ¡5:4832 ¡0:1849 ¡0:1261 ¡1:2909 ¡0:4924

¡3:6732 9:5917 ¡2:2604 ¡0:5467 1:1742 0:5314

¡0:0959 ¡1:7496 6:8519 ¡0:6485 1:9893 0:8652

¡0:5729 ¡3:7078 ¡5:6821 20:6388 ¡2:2927 ¡1:2986

¡0:6694 0:9088 1:9893 ¡0:2617 7:3972 ¡1:1135

¡0:3298 0:5314 1:1178 ¡0:1915 ¡1:4386 11:3892

Bsd ˆ

0:5900 ¡0:7085 ¡0:0185 ¡0:1105 ¡0:1291 ¡0:0636

¡0:7085 1:2394 ¡0:2261 ¡0:4791 0:1174 0:0687

¡0:0185 ¡0:2261 0:6853 ¡0:5683 0:1990 0:1118

¡0:1105 ¡0:4791 ¡0:5683 18:0853 ¡0:2293 ¡0:1678

¡0:1291 0:1174 0:1990 ¡0:2293 0:7398 ¡0:1439

¡0:0636 0:0687 0:1118 ¡0:1678 ¡0:1439 1:4716

The linearized continuous time model in the lateral plane is

cAl ˆ03£3 I3£3

Al1 Al2

; cBl ˆ03£3

Bl1

; cBdistl ˆ

03£3

Bld

; Cl ˆ I3£3 03£3 Š

where

Al1 ˆ

1:9899 ¡1:8935 ¡3:6015

25:4048 30:0882 4:3434

¡14:9053 1:6485 ¡10:0375

; Al2 ˆ

¡51:3510 6:2387 44:7064

61:9299 ¡23:1733 ¡53:9165

44:7064 ¡5:4315 ¡63:2251

Bl1 ˆ

7:3338 ¡2:9551 ¡6:3848

¡8:8446 10:9764 7:7002

¡6:3848 2:5727 9:0296

; Bld ˆ

1:8404 ¡2:2195 ¡1:6023

¡2:2195 8:2443 1:9323

¡1:6023 1:9323 2:2660

DESIGN FOR A STABILIZING CONTROLLER FOR A 10 DOF BIPEDAL ROBOT 43

C12899 ß IMechE 2001 Proc Instn Mech Engrs Vol 215 Part C at The University of Manchester Library on November 12, 2013pic.sagepub.comDownloaded from