Professional Documents
Culture Documents
S(q) +C(q, q)
S(q)], and D
1
= S
T
(q)D
q
.
The force multiplier l
n
can be obtained by (8)
l
n
= Z
1
((M(q)
nlm
i=1,i=j
m
ji
z
hi
+
nlm
i=1,i=j
c
ji
(q, q) z
hi
= U
j
(17)
Remark 3: As in the scheme for the biped, the local
dynamics (17) consists of two parts: the rst part is
the local dynamics of each subsystem with parameter
uncertainty and local disturbances, and the second part is
the interconnections among these subsystems. Since the
bound on the parameter uncertainty and disturbances of
each subsystems depend on local variables and are
relatively easy to obtain, their effects can be compensated
separately by designing a control for each of them to reduce
conservativeness.
4 Impact model
The impact between the swing foot and the ground is
assumed as a rigid collision. We make two assumptions
on the impact model: (i) there is kinetic energy reduction
at every impact and; (ii) the impact velocity becomes very
small and the legs have no bounce. If we assume that the
impact occurs over an innitesimally small period of time,
then (1) all velocities remain nite and; (2) there is no
change in position of the system. If t is the duration of
collision and F
ext
is the impact force during collision,
then the force impulse because of the impact at time is
given by
M
2
( z
+
h
z
h
) = F
ext
(t, z
h
, z
h
) (18)
where z
+
h
( z
h
) denotes the velocity just after (respectively,
before) an impact.
The rst assumption about the kinetic energy reduction
at impact is given by K
+
K
= DK 0, where
K
=
1
2
( z
h
)
T
M
2
( z
h
) and K
+
=
1
2
( z
+
h
)
T
M
2
( z
+
h
) denote the
pre-impact and post-impact kinetic energy, respectively. The
second assumption leads to F(z
h
) = 0. Then J = F/z
h
,
then we have that
J z
h
= 0 (19)
and F
ext
= J
T
l
f
where l
f
= [l
ft
, l
fn
] with l
ft
and l
fn
corresponding to the tangential and normal forces at the
moment of impact.
5 Control objective
In order to balance the biped, we should give the desired
position r
d
c
and velocity r
d
c
for the COM. Therefore the
rst control objective is to design a balancing control such
that the tracking error of r
c
and r
c
from their respective
desired trajectories r
d
c
and r
d
c
to be within a small
neighbourhood of zero, that is, r
c
r
d
c
1
1
, and
r
c
r
d
c
1
2
. The desired reference trajectory z
d
h
is
assumed to be bounded and uniformly continuous, and has
bounded and uniformly continuous derivatives up to the
second order.
The second control objective can be specied as designing
a controller that ensures the tracking error of z
h
from
their respective desired trajectories z
d
h
to be within a
small neighbourhood of zero, that is, z
h
(t) z
d
h
e
1
,
z
h
(t) z
d
h
e
2
where e
1
. 0 and e
2
. 0. Ideally, e
1
and
e
2
should be the threshold of measurable noise.
In order to avoid the slipping or slippage and tip-over, from
(3), r
c
r
d
c
brings the ground applied constraints force
to a desired value l
d
G
= [l
dT
n
, l
dT
h
]
T
; therefore the constraint
force errors and (l
G
l
d
G
) should be to be within a small
neighbourhood of zero, that is, l
G
l
d
G
6, where > 0
is the threshold of measurable noise. For the impact phase,
we should guarantee the system stability during the
transition phase.
The controller design will consist of two stages: (i) a virtual
control input l
d
G
is designed, so that the subsystems (3)
converge to the desired trajectory, and (ii) the actual control
input is designed in such a way that z
h
z
d
h
and l
G
l
d
G
to be stabilised to the origin.
Lemma 1: For x > 0 and 1, we have ln(cosh(x)) +d x.
Proof: If x 0, we have
_
x
0
2
e
2s
+1
ds ,
_
x
0
2
e
2s
ds = 1 e
2x
, 1
Therefore ln(cosh(x)) +d ln(cosh(x)) +
_
x
0
2
e
2s
+1
ds with
1. Let
f (x) = ln(cosh(x)) +
_
x
0
2
e
2s
+1
ds x
we have
f (x) = tanh(x) +
2
e
2x
+1
1
=
e
x
e
x
e
x
+e
x
+
2
e
2x
+1
1 = 0
From the mean value theorem, we have
f (x) f (0) =
f (x)(x 0)
Since f(0) = 0, we have
f (x) = 0
that is, ln(cosh(x)) +
_
x
0
2
e
2s
+1
ds = x, then, we have
ln(cosh(x)) +d x. This completes the proof.
Remark 4: Lemma 1 is used to facilitate the control design.
www.ietdl.org
164 IET Control Theory Appl., 2013, Vol. 7, Iss. 2, pp. 161175
& The Institution of Engineering and Technology 2013 doi: 10.1049/iet-cta.2012.0066
Assumption 1: Time-varying positive function f (t) converges
to zero as t and satises
lim
t1
_
t
0
f (v) dv = @ , 1
with a nite constant .
6 Adaptive robust control
6.1 Balancing control
For subsystem (3), we can dene
e
c
= r
c
r
d
c
(20)
r
r
c
= r
d
c
L
c
e
c
(21)
s = e
c
+L
c
e
c
(22)
with L
c
being diagonal constant matrix.
Considering (21) and (22), we can rewrite (3) as
M
r
s = l
G
D (23)
D = M
r
r
r
c
+G +D
r
(24)
where M
r
is diagonal and l
G
[ R
3
.
Lemma 2: Consider Property 2, the upper bound of kth
sub-vector D
k
of satises
D
k
ln (cosh(C
k
)) +d (25)
where 1 is a small function, C
k
= g
T
k
w
k
with w
k
=
[1, sup s
k
]
T
, and g
k
= [g
k1
, g
k2
]
T
is a vector of positive
constants dened below.
Proof: According to Property 2, the upper bound of D
k
satises
D
k
q
1
r
d
ck
L e
ck
+q
2
+q
3
q
1
r
d
ck
+q
1
L e
ck
+q
2
+q
3
(26)
Consider the linear system dened by e
ck
= Le
ck
+s
k
,
e
ck
(0) = e
0
. Since the matrix is Hurwitz, there exist
constants b
1
, b
2
, b
3
and b
4
such that e
ck
(t) b
1
e
ck0
+
b
2
sup s
k
and e
ck
(t) b
3
e
ck0
+b
4
sup s
k
.
Substituting the later equation into (26), we could nally
obtain D
k
g
k1
+g
k2
sup s
k
.
For the kth vector l
Gk
, we can design the desired producing
constrain force l
Gk
as
l
Gk
= Y
k
s
k
ln(cosh(
C
k
))sgn(s
k
) d sgn(s
k
)
C
k
= g
T
k
w
k
(27)
g
k
= h g
k
+kw
k
s
k
(28)
where the designed constant Y
k
. 0, k . 0, if s
k
0,
sgn(s
k
) = 1, else sgn(s
k
) = 1; 1 and in the simulation,
we choose d = 1 +
1
(1+t)
2
; and satises Assumption 1, that
is, lim
t1
h(t) = 0 and lim
t1
_
t
0
h(v)dv = @
h
, 1 with
the nite constant @
h
, that is, can be chosen as
1
(1+t)
2
.
Remark 5: A control block diagram that summarises the
control is shown in Fig. 2. The proposed approach is
based generally on the idea of duality of control with
respect to position and force, as well as to the
orthogonality of the subspaces of possible displacements
and reaction forces of a robot in contact with the
environment. Consider the position of the base (COM) is
stabilised by the force control, the required force is
realised by the ground reaction force. While the posture
and the joint angle are used to project dynamics on the
reduced motion subspace of the generalised coordinates. A
computed torque method can be established to linearise
the motion subproblem. Once this is done, a force control
will follow as in any other hybrid control scheme. Thus,
the proposed control (26) and (41)(43) constitute one of
the main contributions of this paper, as seen in Fig. 2,
achieves global tracking convergence. Once we have
decouple linearised the position and force patterns, we will
proceed to synthesise respectively a full-order feedback
controller for the position loop and an proportional action
to regulate the force loop.
Theorem 1: Consider the dynamics of COM described by (3),
using the control law (27) and the adaptive law (28), the
following hold for any (r
c
(0), r
c
(0)):
(i) r
c
= [r
c1
, r
c2
, r
c3
]
T
converges to the desired trajectory
r
d
c
= [r
d
c1
, r
d
c2
, r
d
c3
]
T
as t ;
(ii) e
ck
and e
ck
converge to 0 as t , and l
G
is bounded for
t 0.
Proof: To facilitate the control design, consider the following
Lyapunov function candidate with
() = ()
() as
V =
1
2
s
T
M
rc
s +
3
k=1
2
i=1
1
2k
g
ki
g
ki
(29)
The derivative of V along (23) is given by
V = s
T
M
rc
s +
3
k=1
2
i=1
1
k
g
ki
g
ki
=
3
k=1
s
k
[l
Gk
D
k
] +
3
k=1
2
i=1
1
k
g
ki
g
ki
(30)
Fig. 2 Control structure
www.ietdl.org
IET Control Theory Appl., 2013, Vol. 7, Iss. 2, pp. 161175 165
doi: 10.1049/iet-cta.2012.0066 & The Institution of Engineering and Technology 2013
Integrating (27) into (30), we have
3
k=1
s
k
[l
Gk
D
k
] +
3
k=1
2
i=1
1
k
g
ki
g
ki
=
3
k=1
s
k
[Y
k
s
k
ln(cosh(
C
k
))sgn(s
k
)
dsgn(s
k
) D
k
] +
3
k=1
2
i=1
1
k
g
ki
g
ki
=
3
k=1
Y
k
s
2
k
3
k=1
ds
k
+
3
k=1
2
i=1
g
ki
g
ki
3
k=1
s
k
ln(cosh(
C
k
))sgn(s
k
)
3
k=1
s
k
D
k
3
k=1
Y
k
s
2
k
3
k=1
ds
k
3
k=1
s
k
ln(cosh(
C
k
)) +
3
k=1
s
k
D
k
3
k=1
2
i=1
h
k
g
ki
g
ki
3
k=1
2
i=1
g
ki
w
ki
s
k
(31)
Considering Lemmas 1 and 2 and using g
ki
g
ki
= g
ki
(g
ki
g
ki
) = (1/4)g
2
ki
((1/2)g
ki
g
ki
)
2
(1/4)g
2
ki
, we have
3
k=1
Y
k
s
2
k
3
k=1
s
k
ln(cosh(
C
k
))
+
3
k=1
s
k
ln(cosh(C
k
)
3
k=1
2
i=1
g
ki
w
ki
s
k
3
k=1
2
i=1
h
k
g
ki
g
ki
3
k=1
Y
k
s
2
k
+
3
k=1
2
i=1
h
k
g
ki
g
ki
3
k=1
Y
k
s
2
k
+
1
4
3
k=1
2
i=1
h
k
g
2
ki
(32)
Since (1/4)
3
k=1
2
i=1
h
k
g
2
ki
is bounded and converges
to zero as t by noting lim
t1
h = 0, there exists
t . t
1
, (1/4)
3
k=1
2
i=1
h
k
g
2
ki
@
2
, when |s
k
|
....
@
2
Y
min
_
,
with Y
min
= min(Y
1
, Y
2
, . . . , Y
nlm
),
V 0, from above
all, s
k
converges to a small set containing the origin as
t .Integrating both sides of the above equation gives
V(t) V(0) ,
_
t
0
3
k=1
Y
k
s
2
k
ds +
1
4
3
k=1
2
i=1
@
h
k
g
2
ki
(33)
by noting lim
t1
h = 0, and lim
t1
_
t
0
h(v)dv = @
h
, 1.
Thus V is bounded, which implies that s [ L
1
. From
s = e
c
+Le
c
, it can be obtained that e
c
, e
c
[ L
1
. As we
have established e
c
, e
c
[ L
1
, we conclude that r
c
, r
c
,
r
c
[ L
1
.
Therefore all the signals on the right-hand side of (3) are
bounded, it is easy to conclude that l
G
is bounded from
(27).
6.2 Posture control
Since the dynamics uncertainties of the system, such as
dynamics parameters and disturbances in the system, are
usually hard to measure and construct, we need to estimate
those uncertainties in this paper, we develop robust control
combing on-line parameters identication.
Let
e = z
h
z
d
h
(34)
z
r
h
= z
d
h
L
h
e (35)
r = e +L
h
e (36)
with L
h
being diagonal positive-denite constant matrix.
Considering (35) and (36), we can rewrite (13) as
M
2
r +C
2
r = U J (37)
J = M
2
z
r
h
+C
2
z
r
h
+D
2
(38)
According to the denition of J [ R
(nlm)
, we denote
J
k
, k = 1, 2, . . . , (n l m) as the kth elements of J,
which corresponds to the kth equation in the dynamics
of the jth sub-system. Similarly, we denote r
k
as the kth
element of r [ R
(nlm)
, and in addition, denote r =
[r
1
, r
2
, . . . , r
nlm
]
T
.
We dene the kth component of trunk dynamics in (37) as
nlm
j=1
m
kj
r
j
+
nlm
j=1
c
kj
(q, q)r
j
= U
k
J
k
(39)
Lemma 3: Consider Property 4, the upper bound of Jsatises
J
k
ln( cosh (F
k
)) +d (40)
where is a small function, F
j
= a
T
k
w with w =
[1, supr, supr
2
]
T
, and a
k
= [a
k1
, a
k2
, a
k3
]
T
is a
vector of positive constants dened below.
Proof: According to Property 4, the upper bound of J
k
satises
J
k
c
1
z
d
hk
L e
k
+(c
2
+c
3
z
d
hk
+ e
k
) z
d
hk
Le
k
+c
4
+c
5
c
1
z
d
hk
+c
1
L e
k
+c
2
z
d
hk
+c
2
Le
k
+c
3
z
d
hk
2
+c
3
z
d
hk
Le
k
+c
3
e
k
z
d
hk
+c
3
Le
k
e
k
+c
4
+c
5
c
1
z
d
hk
+c
2
z
d
hk
+c
3
z
d
hk
2
+c
4
+c
5
+(c
2
L +c
3
z
d
hk
L)e
k
+c
3
Le
k
e
k
+(c
1
L +c
3
z
d
hk
) e
k
b
1
+b
2
e
k
+b
3
e
k
+b
4
e
k
2
+b
5
e
k
2
(41)
www.ietdl.org
166 IET Control Theory Appl., 2013, Vol. 7, Iss. 2, pp. 161175
& The Institution of Engineering and Technology 2013 doi: 10.1049/iet-cta.2012.0066
where b
1
= c
1
z
d
hk
+c
2
z
d
hk
+c
3
z
d
hk
2
+c
4
+c
5
, b
2
=
c
2
L +c
3
z
d
hk
L, b
3
= c
1
L +c
3
z
d
hk
, b
4
=
1
2
c
3
L,
b
5
= b
4
.
Consider the linear system dened by e
k
= Le
k
+r
k
,
e
k
(0) = e
0
. Since matrix is Hurwitz, there exist
constants a
1
, a
2
, a
3
and a
4
, such that e
k
(t)
a
1
e
k0
+a
2
supr
k
and e
k
(t) a
3
e
k0
+a
4
supr
k
.
Substituting these two equations into (41), we could nally
obtain J
k
a
k1
+a
k2
supr
k
+a
k3
supr
k
2
.
We propose the following control for the biped
U
k
= k
k
r
k
ln(cosh(
F
k
))sgn(r
k
) dsgn(r
k
) (42)
t
a2
= l
d
h
K
h
(l
h
l
d
h
) (43)
t
b
= l
d
n
K
n
(l
n
l
d
n
) (44)
F
k
= a
T
k
w
k
a
k
= S a
k
+Gw
k
r
k
(45)
where k
k
. 0, > 1, if r
k
0, sgn(r
k
) = 1, else
sgn(r
k
) = 1, and > 0, satises Assumption 1, such as,
lim
t1
S = 0, and lim
t1
_
t
0
S(v)dv = r
S
, 1 with the
nite constant r
S
, that is, S =
1
(1+t)
2
. It is observed that the
controller (42) only adopt the local feedback information.
Theorem 2: Consider the mechanical system described by
(13) and its dynamics model (39), using the control law
(42) and (45), the following hold for any (z
h
(0), z
h
(0)):
1. r
k
converges to a set containing the origin as t;
2. e
k
and e
k
converge to 0 as t; and are bounded for all
t 0; and
3. l
G
l
d
G
= [e
T
h
, e
T
n
]
T
= [(l
h
l
d
h
)
T
, (l
n
l
d
n
)
T
]
T
is
bounded and can be made arbitrarily small.
Proof: To facilitate the control design, consider the following
Lyapunov function with a
k
= a
k
a
k
as
V =
1
2
r
T
M
2
r +
n1m
k=1
3
i=1
1
2G
a
ki
a
ki
(46)
The derivative of V along (39) is given by (see (47))
Considering Property 3, and integrating (42) into (47), we
have
nlm
k=1
r
k
[U
k
J
k
] +
nlm
k=1
3
i=1
1
G
a
ki
a
ki
=
nlm
k=1
r
k
[ k
k
r
k
ln(cosh (
F
k
))sgn(r
k
)
dsgn(r
k
) J
k
]
+
nlm
k=1
3
i=1
a
ki
G
1
a
ki
=
nlm
k=1
k
k
r
2
k
nlm
k=1
dr
k
+
nlm
k=1
3
i=1
a
ki
G
1
a
iki
nlm
k=1
r
k
ln(cosh(
F
k
))sgn(r
k
)
nlm
k=1
r
k
J
k
nlm
k=1
k
k
r
2
k
nlm
k=1
dr
k
nlm
k=1
r
k
ln(cosh (
F
k
)) +
nlm
k=1
r
k
J
k
nlm
k=1
3
i=1
S
G
a
ki
a
ki
nlm
k=1
3
i=1
a
ki
w
ki
r
k
(48)
Considering Lemmas 1 and 3 and using a
ki
a
ki
= a
ki
(a
ki
a
ki
) = (1/4)a
2
ki
((1/2)a
ki
a
ki
)
2
(1/4)a
2
ki
, we have
nlm
k=1
k
k
r
2
k
nlm
k=1
r
k
ln(cosh (
F
k
))
+
nlm
k=1
r
k
ln(cosh (F
k
)
nlm
k=1
3
i=1
a
ki
w
ki
r
k
nlm
k=1
3
i=1
S
G
a
ki
a
ki
nlm
k=1
k
k
r
2
k
+
nlm
k=1
3
i=1
S
G
a
ki
a
ki
nlm
k=1
k
k
r
2
k
+
1
4
nlm
k=1
3
i=1
S
G
a
2
ki
(49)
Since (1/4)
nlm
k=1
3
i=1
S
G
a
2
ki
is bounded and converges to
V =
1
2
[r
T
M
2
r + r
T
M
2
r +r
T
M
2
r] +
nlm
k=1
3
i=1
1
G
a
ki
a
ki
=
1
2
nlm
k=1
nlm
j=1
r
k
m
kj
r
j
+
nlm
k=1
nlm
j=1
r
k
m
kj
r
j
+
nlm
k=1
3
i=1
1
G
a
ki
a
ki
=
nlm
k=1
r
k
nlm
j=1
1
2
m
kj
r
j
nlm
j=1
c
kj
r
j
+U
k
J
k
_ _
+
nlm
k=1
3
i=1
1
G
a
ki
a
ki
(47)
www.ietdl.org
IET Control Theory Appl., 2013, Vol. 7, Iss. 2, pp. 161175 167
doi: 10.1049/iet-cta.2012.0066 & The Institution of Engineering and Technology 2013
zero as t by noting lim
t1
G = 0, there exists t . t
1
,
1
4
nlm
k=1
3
i=1
S
G
a
2
ki
r
3
with a nite small constant r
3
,
when |r
k
|
....
r
3
k
min
_
with k
min
= min(k
1
, k
2
, . . . , k
nlm
),
nlm
k=1
k
k
r
2
k
ds +
1
4
nlm
k=1
3
i=1
r
G
a
2
ki
(50)
Table 1 Range of each joint for the biped robot
Range of joint
angel for human
Range of joint
angle for our robot
leg
hip roll 45
20
40
20
pitch 125
15
130
40
yaw 45
45
45
45
knee pitch 0
130
150
ankle roll 20
30
30
40
pitch 20
45
50
45
toe pitch 45
30
30
=
1
2
( z
h
z
h
)
T
M
2
( z
h
z
h
) and V
+
=
1
2
( z
+
h
z
h
)
T
M
2
( z
+
h
z
h
) denote the Lyapunov function candidate before
and after the switching, and z
+
h
and z
h
represent the post-
and pre-switch velocities, and z
h
denotes the single-support
or double support velocity, respectively. The Lyapunov
function change during the switching can be simplied as
follows: DV=V
+
V
=K
+
K
[ z
+T
h
M
2
z
h
z
T
h
M
2
z
h
]=
DK z
T
h
M
2
( z
+
h
z
h
). Because the foot cannot be penetrated
into the ground; therefore z
h
should be on the tangential
plane of the ground, while D z
h
should be in the vertical
plane of the ground. Considering (18) and (19), we have
12.0 9.0 6.0 3.0 0.0
0.0
1.0
0.375
-0.25
-0.875
-1.5
Analysis: LastRun_PD_002 2012-05-27 17:25:10
Joint Angles of Left Lower Limb
Time (sec)
A
n
g
l
e
(
r
a
d
)
Actual_Left_Ankle_Pitch
Desired_Left_Ankle_Pitch
Actual_Left_Ankle_Roll
Desired_Left_Ankle_Roll
Actual_Left_Hip_Pitch
Desired_Left_Hip_Pitch
Actual_Left_Hip_Roll
Desired_Left_Hip_Roll
Actual_Left_Knee_Pitch
Desired_Left_Knee_Pitch
Fig. 9 Trajectories of left leg (unit: rad) under PD control
12.0 9.0 6.0 3.0 0.0
0.0
4.5E+005
4.0E+005
3.5E+005
3.0E+005
2.5E+005
2.0E+005
1.5E+005
100000.0
50000.0
0.0
Analysis: LastRun_PD_002 2012-05-27 17:25:10
Joint Torques of Left Lower Limb
Time (sec)
T
o
r
q
u
e
(
N
*
m
m
)
torque_LAP
torque_LAR
torque_LHP
torque_LHR
torque_LKN
Fig. 10 Torques of left leg (unit: Nmm) under PD control
www.ietdl.org
IET Control Theory Appl., 2013, Vol. 7, Iss. 2, pp. 161175 171
doi: 10.1049/iet-cta.2012.0066 & The Institution of Engineering and Technology 2013
DV = DK z
T
h
F
ext
= DK z
T
h
J
T
l
f
= DK , 0. Therefore
the Lyapunov function is decreasing during impact, the
motion of the system is also stable.
8 Simulations
Consider a 12-DOF biped robot shown in Fig. 1 modelling
using ADAMS, which consists of a torso, and a pair of legs
composed of six links. The left and right legs are numbered
Legs 1 and 2, respectively. The height of the biped is
1.2 m, the lower limbs are 460 mm, and the height of foot
is 90 mm, the weight is 22 kg. The range of each joint for
the biped in ADAMS is shown in Table 1, and inertia
parameters of the biped are listed in Table 2.
In this study, a cycloidal prole is used for the trajectories
of the hip and ankle joints of the swinging leg, which can be
12.0 9.0 6.0 3.0 0.0
0.0
1.5
1.0
0.5
0.0
-0.5
-1.0
Analysis: LastRun_PD_002 2012-05-27 17:25:10
Joint Angles of Right Lower Limb
Time (sec)
A
n
g
l
e
(
r
a
d
)
Actual_Right_Ankle_Pitch
Desired_Right_Ankle_Pitch
Actual_Right_Ankle_Roll
Desired_Right_Ankle_Roll
Actual_Right_Hip_Pitch
Desired_Right_Hip_Pitch
Actual_Right_Hip_Roll
Desired_Right_Hip_Roll
Actual_Right_Knee_Pitch
Desired_Right_Knee_Pitch
Fig. 11 Trajectories of right leg (unit: rad) under PD control
12.0 9.0 6.0 3.0 0.0
0.0
4.0E+005
3.0E+005
2.0E+005
1.0E+005
0.0
Analysis: LastRun_PD_002 2012-05-27 17:25:10
Joint Torques of Right Lower Limb
Time (sec)
T
o
r
q
u
e
(
N
*
m
m
)
torque_RAP
torque_RAR
torque_RHP
torque_RHR
torque_RKN
Fig. 12 Torques of right leg (unit: Nmm) under PD control
www.ietdl.org
172 IET Control Theory Appl., 2013, Vol. 7, Iss. 2, pp. 161175
& The Institution of Engineering and Technology 2013 doi: 10.1049/iet-cta.2012.0066
found in [33]. This prole is used because it shows a similar
pattern to a humans ankle trajectory in normal walking and
it describes a simple function, which can be easily changed
for different walking patterns. The equations are given as
follows: x
a
(i) =
a
p
[
2p
k
i sin(
2p
k
i)], z
a
(i) =
d
2
[1 cos(
2p
k
i)],
x
hip
(i) =
1
2
x
a
(i) +
a
2
, z
hip
(i) =
1
2
z
a
(i) +l
1
+l
2
d
2
, where x
hip
and z
hip
denote the positions of the hip, and x
a
and z
a
denote the positions of the swinging angle, a is the step
length, d is the height of the swinging ankle, is the total
sampling number of a step, and i is the sampling index, and
l
i
is the length of link i. In order to avoid the tumbling, we
design the lateral trajectory as y
h
(i) = 102.5 sin(
p
k
i), where
y
h
is the projection of COM on the ground such that the
position of COM is in the foot support area, n is the total
sampling number of a step, and i is the sampling index,
and 102.5 mm is the distance between the COM and
support leg. In the simulation, we choose the parameters
as a = 200 mm, d = 120 mm, and l
1
= 235.5 mm,
l
2
= 233.5 mm, = 200. Therefore we can obtain the every
joint in the working space. For the support leg, q
1
and q
2
,
the constraint equation is given by l
2
cos(q
2
) +l
3
cos(q
3
) =
z
hip
l
4
with the angle height l
4
. Therefore, q
2
is
independent coordinate, and q
3
= F(q
2
) =
cos
1 z
h
ipl
4
l
1
cos (q
2
)
l
3
we design the H = [1, 0, 0, 0;
F
q
1
, 0, 0,
0; 0, 1, 0, 0; 0, 0, 1, 0; 0, 0, 0, 1], J
n
= [0, 0, 0, 1, 0, 0, 0, 0,
1, 0; 0, 0, 0, 0,1, 0, 0, 0, 0, 1], S = [1
33
, 0
33
; 0
23
, 0
23
;
0
33
, 1
33
, 0
23
, 0
33
], l=4, m=2.
The parameters in the adaptive control are set as