Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
Automatica
journal homepage: www.elsevier.com/locate/automatica
Brief paper
School of Information Science & Technology, Sun Yat-Sen University, Guangzhou, 510275, China
article
info
Article history:
Received 14 June 2009
Received in revised form
9 February 2010
Accepted 21 April 2010
Available online 7 June 2010
Keywords:
Wheeled inverted pendulums
Nonholonomic constraints
Unmodelled dynamics
Zero dynamics
abstract
Previous works for wheeled inverted pendulums usually eliminate nonholonomic constraint force in
order to make the control design easier, under the assumption that the friction force from the ground is
as large as needed. Nevertheless, such an assumption is unfeasible in practical applications. In this paper,
adaptive robust motion/force control for wheeled inverted pendulums is investigated with parametric
and functional uncertainties. The proposed robust adaptive controls based on physical properties of
wheeled inverted pendulums make use of online adaptation mechanism to cancel the unmodelled
dynamics. Based on Lyapunov synthesis, the proposed controls ensure that the system outputs track the
given bounded reference signals within a small neighborhood of zero, and guarantee the semi-global
uniform boundedness of all closed loop signals. The effectiveness of the proposed controls is verified
through extensive simulations.
2010 Elsevier Ltd. All rights reserved.
1. Introduction
Wheeled inverted pendulums have attracted a lot of attention
recently (Brooks et al., 2004; Gans & Hutchinson, 2006; Grasser,
Arrigo, Colombi, & Rufer, 2002; Jung & Kim, 2008; Li & Luo,
2009; Nasrallah, Michalska, & Angeles, 2007; Pathak, Franch, &
Agrawal, 2005) as shown in Fig. 1. Similar systems like the cart
and pendulums have been studied in the literature Ibanez, Frias,
and Castanon (2005) and Zhang and Tarn (2002). The differences
from these systems are that the inverted pendulums motion in the
present system is not planar and the motors driving the wheels are
directly mounted on the pendulum body (Pathak et al., 2005).
Motion of wheeled inverted pendulums is governed by underactuated configuration, i.e., the number of control inputs is less
than the number of degrees of freedom to be stabilized (Isidori,
Marconi, & Serrani, 2003), which makes it difficult to apply
the conventional robotics approach to control EulerLagrange
systems. Due to these reasons, increasing effort has been made
towards control design that guarantees stability and robustness for
mobile wheeled inverted pendulums.
0005-1098/$ see front matter 2010 Elsevier Ltd. All rights reserved.
doi:10.1016/j.automatica.2010.05.015
Although wheeled inverted pendulums systems are intrinsically nonlinear and their dynamics are described by nonlinear differential equations, if the system operates around an operating
point, and the signals involved are small, we can obtain a linear
model approximating the nonlinear system in the region of operation. In Ha and Yuta (1996), motion control was proposed using a linear state-space model. In Grasser et al. (2002), dynamics
was derived using a Newtonian approach and the control was designed based on the dynamic equations linearized around an operating point. In Salerno and Angeles (2003), dynamic equations of
the inverted pendulum were studied involving pitch and rotation
angles of the two wheels as the variables of interest, and in Salerno
and Angeles (2004) a linear controller was designed for stabilization considering robustness as a condition. In Blankespoor and Roemer (2004), a linear stabilizing controller was derived by a planar
model without considering yaw. In Kim, Kim, and Kwak (2005), the
exact dynamics of a two-wheeled inverted pendulum was investigated, and linear feedback control was developed on the dynamic
model. In Pathak et al. (2005), a two-level velocity controller via
partial feedback linearization and a stabilizing position controller
were derived.
Based on the idea of linearization, a model-based approach
is generally utilized in dynamic control. If accurate knowledge
of the dynamic model is available, the model-based control
can provide an effective solution to the problem. However,
wheeled inverted pendulum control is characterized by unstable
balance and unmodelled dynamics, and subject to time varying
external disturbances, in the form of parametric and functional
uncertainties, which are generally difficult to model accurately.
Therefore, traditional model-based control may not be the ideal
Pm Pn
i=1
j =1
|aij |2 .
Lemma 2.1. Let e = H (s)r with H (s) representing a (n m)dimensional strictly proper exponentially stable transfer function,
T mr
and e denoting its input
and output, respectively. Then r Lm
L
2
T
implies that e, e Ln2
Ln , e is continuous, and e 0 as t .
If, in addition, r 0 as t , then e 0 (Ge, Lee, & Harris,
1998).
Lemma 2.2. For x 0 and = 1 + (1+1t )2 1 with t > 0, we have
ln(cosh(x)) + x.
1347
Rx
Rx
< 0 e22 d = 1 e2x <
Rx
1 + (1+1t )2 . Therefore, ln(cosh(x)) + ln(cosh(x)) + 0 e22+1 d .
Rx
Let f (x) = ln(cosh(x)) + 0 e22+1 d x, we have f (x) = tanh(x) +
Proof. If x 0, we have
2
d
0 e2 + 1
e
1 = eex
+ e2x2+1 1 = 0. From the Mean Value Theorem,
+ex
we have f (x) f (0) = f (x)(x
R x0). Since f (0) = 0, we have
f (x) = 0, that is, ln(cosh(x)) + 0 e22+1 d = x, then, we have
ln(cosh(x)) + x. This completes the proof.
2
e2x +1
3. System description
3.1. Dynamics of mobile wheeled inverted pendulums
Consider the following wheeled inverted pendulum dynamics
described by Lagrangian formulation:
M (q)q + V (q, q )q + G(q) + F = B + f
(1)
Mv
M (q) =
Mv
G(q) =
f = fv
Gv
,
G
f
T
Mv
,
M
F =
Vv
V (q, q ) =
Vv
Fv
,
F
= v
B(q) =
0
Vv
,
V
Bv
0
0
,
B
T
1348
(2)
(3)
Denote R(q) = [r1 (q), . . . , rm (q), rm+1 (q), . . . , rm+n ] and define
an auxiliary time function z (t )
Rm+n , and z (t ) =
T
[z1 (t ), . . . , zm (t ), zm+1 , . . . , zm+n ] such that
q = R(q)z (t ) = r1 (q)z1 (t ) + + rm (q)zm (t )
(4)
Eq. (4) is the kinematic model for the wheeled inverted pendulums.
Usually, z (t ) has physical meaning, consisting of the angular
velocity , the linear velocity v , and the tilt angle , i.e., z (t ) =
[v ]
T . Eq. (4) describes the kinematic relationship between the
motion vector q and the velocity vector z (t ).
Differentiating (4) yields
q = R (q)z + R(q)z .
z = [R (q)R(q)]
"
M1 =
m12
m22
m32
g1
g2 ,
g3
m13
m23 ,
m33
d1
d2 ,
d3
" #
G1 =
F1 =
" #
v1
V1 z = v2
v3
z1
z2 ,
z3
" #
z=
" #
1
R a = 2
T
(13)
(15)
1
1
m31 m
11 d1 = m31 m11 1
R (q)q.
1 T
(6)
(7)
with V = [M (q)R (q) + V (q, q )R(q)]. Substituting (4) and (5) into
(1), and then pre-multiplying (1) by RT (q), the constraint matrix
J T (q) can be eliminated by virtue of (3). As a consequence, we
have the transformed nonholonomic system
(8)
m11
m21
m31
" #
(5)
(10)
(11)
Let a = m22 m21 m11 m12 , b = m23 m21 m11 m13 , l = m32
1
1
1
m31 m
z2 +
11 m12 , j = m33 m31 m11 m13 , e = (m22 m21 m11 m12 )
1
1
(m23 m21 m11 m13 )z3 , f = (m32 m31 m11 m12 )z2 + (m33
1
1
1
m31 m
z3 , h = (m21 m21 m
z1 + g2 + d2 m21 m
11 m13 )
11 m11 )
11 g1
1
1
1
m21 m11 d1 , k = (m31 m31 m11 m11 )z1 + g3 + d3 m31 m11 g1
1
T
m31 m
11 d1 . Then, let = [z3 , z2 ] , we can rewrite (15) and (16) as
M + V + D = B1 U
where M =
1
m33 m31 m11 m13
1
m23 m21 m11 m13
j
b
l
a
, D =
(17)
hi
k
h
1
m32 m31 m11 m12
1
m22 m21 m11 m12
, B1 =
1
m31 m11
1
m21 m11
0
1
, V =
= diag[1, 1], U =
[1 , 2 ]T .
Property 3.1. The inertia matrix M is symmetric and positive
definite.
2V is skew-symmetric.
Property 3.2. The matrix M
(9)
(16)
(12)
4. Problem statement
4.1. Control objectives
By appropriate selection of a set of vector z (t ) Rm+n , since
the control input is only m dimension, and m > n , only m
variables of z (t ) can be controlled, the control objective can be
specified as: design a controller that ensures the tracking errors
of zi (1 i m) from their respective desired trajectories zid (t ) to
be within a small neighborhood of zero, i.e.,
|zi (t ) zid (t )| i ,
i = 2, 3
(18)
1349
1
4 )) + ),
u24 = sgn(s)(ln(cosh(
b
1
5 )) + ),
u25 = sgn(s)(ln(cosh(
b
1
6 )) + ),
u26 = sgn(s)(ln(cosh(
b
(27)
(28)
(29)
c1 (0) > 0
c 2 = 2 c2 + 2 kskkr k, c2 (0) > 0
c 3 = 3 c3 + 3 kskkr kkqk, c3 (0) > 0
(30)
c 4 = 4 c4 + 4 ksk,
(33)
(31)
(32)
c4 (0) > 0
c 5 = 5 c5 + 5 kskkqk, c5 (0) > 0
c 6 = 6 c6 + 6 kskku1 k, c6 (0) > 0
(34)
(35)
1 = c1 kr k,
2 = c2 kr k,
3 = c3 kqkkr k,
4 = c4 ,
with
(36)
i (t )dt = % <
(37)
Remark 5.1. As we discuss in Section 1, a wheeled inverted pendulum subject to kinematic constraints and dynamic constraints is
apparently different from generalized nonholonomic systems, the
control (23) is proposed based on the obtained reduced model (17),
for the generalized nonholonomic system, if we can obtain the corresponding reduced model similar to (17), the control (23) is also
applicable.
= r + s.
(19)
Ms = V s Mr V r D + B1 U.
(20)
U = u1 + u2
1
1 )) + ),
u21 = sgn(s)(ln(cosh(
b
1
2 )) + ),
u22 = sgn(s)(ln(cosh(
b
1
3 )) + ),
u23 = sgn(s)(ln(cosh(
b
1
2
sT M s +
6
1X
2 i=1
ci i1 ci
(38)
1 = sT
V
M s +
1
2
M s +
6
X
ci i1 c i .
(39)
i =1
V1 =
(21)
(23)
(24)
1 = sT B1 U Mr + V r + D
V
(26)
6
X
ci i1 c i .
(40)
i =1
6
X
ci i1 c i
i=1
= sT [(B1 B10 ) u1 + B1
(25)
6
X
u2i Kp s (M M0 )r
i=1
(V V0 )r (D D0 )] +
6
X
i =1
ci i1 c i
1350
= sT Kp s + s B1 u21 (M M0 )r
+ sT B1 (u22 + u23 ) (V V0 )r
T
6
6
=
c6 c6 =
6
6
i
i=1
(41)
B1 u21 (M M0 )r +
1 )) + ) + c1 c 1
c1 kskkr k ksk(ln(cosh(
1
1
c1 kskkr k c1 kskkr k + c1
c1 kskkr k
1
2
1
1 2
1
1
+
c1 c1 =
c1 c1
c1
=
1
1
2
41
c2 kskkr k + c3 kskkqkkr k
3
X
i
i=2
(42)
i )) + )
ksk(ln(cosh(
c4 ksk + c5 kskkqkk k
5
X
5
X
1
ci c i
i
i=4
i )) + )
ksk(ln(cosh(
5
X
1
+
ci c i
i
i=4
c6 c 6
c6 kskku1 k c6 kskku1 k + c6
(45)
6
c6 kskku1 k
6
ci
1
2
2
ci
6
X
i 2
c .
4
i i
i=1
6
X
i 2
ci .
4i
i =1
P6
i 2
i=1 4i ci
(46)
is bounded, there exists
Therefore, all the signals on the right hand side of (20) are
bounded, and we can conclude that s and therefore is bounded.
Thus, s 0 as t can be obtained. Consequently, we have
e 0, e 0 as t . It follows that e , e 0 as t .
5.2. z1 -subsystem stability
Finally, for system (15)(16) under control laws (21), apparently, the z1 -subsystem (14) can be rewritten as
= f (, , U)
(47)
kv1 + g1 + d1 k L1 k k + L1f
(48)
kf + kk L2 k k + L2f
(49)
(44)
Similarly, considering (29) and (35) and Lemma 2.2, the fifth righthand term of (41) is bounded by
1
c62 .
Assumption 5.1. From (15) and (16), the reference signal satisfies
Assumption 4.1, and the following functions are Lipschitz in ,
i.e., there exist Lipschitz positive constants L1 , L2 , and L1f , L2f ,
such that
i =4
6
46
ci c i
c6
Therefore
i 2
T > t1 ,
c
q i=1 4i i
%1
ksk min (Kp ) , then V 1
i=2
2
6
X
i
P6
3
X
1
ci c i
i
i=2
3
X
Considering (25), (26), (31), (32), and Lemma 2.2, the third
right-hand term of (41) is bounded by
c1 c 1
sT B1 (u22 + u23 ) (V V0 )r +
c6
i =1
Considering (24) and (30), and Lemma 2.2, the second righthand term of (41) is bounded by
T
(50)
2 = V 1 + tanh(z1 )z1
V
1
2 m13 z3 ). (51)
= V 1 + tanh(z1 )m
11 (1 v1 g1 d1 m12 z
(52)
T
1
m31 l + m111 m12
1
1 , and km
m1 j + m1 m
11 k 2 , where 1 and 2 are
31
11 13
bounded constants. Considering Assumption 5.1 and Remark 5.3,
we have
X i
2 1 min (Kp )ksk2 +
ci2
V
2
4
i
i =1
+ 1 (kd k + 2 ) + L2 (kd k + 2 ) + L2f
6
(54)
= Z R+ M1 z + c1 Z R+ M1 zd .
6. Simulation
Let us consider a mobile wheeled inverted pendulum as shown
in Fig. 1. The following variables have been chosen to describe the
vehicle (see also Fig. 1): l , r : the torques of the left and right
wheels; : the tilt angle of the pendulum; : the direction angle
of the mobile platform; r: the radius of the wheels; d: the distance
between the two wheels; 2l: the length of the pendulum; m: the
mass of the mobile pendulum; Mw : the mass of each wheel; Im :
the moment of inertia of the mobile pendulum; Iw : the inertia
moment of each wheel; g: gravity acceleration; : the motion
friction coefficient of the ground.
The wheeled inverted pendulum is subject to the following
constraints x sin y cos = 0. Using the Lagrangian approach,
we can obtain the reduced dynamics for qv = [x, y, ]T , q = ,
J = [sin , cos , 0, 0], and z = [, , ]
T in (13) as
M1 =
m11
(55)
m22
ml cos
0
ml2 sin 2
2
1
ml2 sin 2
2
2 cos t
where m11 =
1
2Mw r 2
r2
2 2
4 mrd2 l sin2
4r 2
I
d2 m
0
0
mgl sin
"
G1 =
ml + Im
ml cos
2
F1 = 1 sin t
2Iw +
0
1
0
V1 =
min (Kp )
b = c1 Z R+ zd + d Kf e
2
0
(53)
+ 2 (L1 (kd k + 1 ) + L1f ).
P6 i 2
Let =
i=1 4i i + 1 (kd k + 2 ) + L2 (kd k + 2 ) + L2f +
2 (L1 (kd k + 1 ) + L1f ) and q
it is apparently bounded positive, we
2
2 0, when ksk
have V
, we can choose the proper
1351
ml sin
ml2 sin 2 ,
2
3 sin t
T
(56)
d2
4r 2
(2Mw r 2 +
).
1352
7. Conclusions
In this paper, robust adaptive motion/force control design is
carried out for dynamic balance and stable tracking of desired trajectories of a mobile wheeled inverted pendulum, in the presence
of unmodelled dynamics, or parametric/functional uncertainties
1353
Li, Z., & Luo, J. (2009). Adaptive robust dynamic balance and motion controls of
mobile wheeled inverted pendulums. IEEE Transactions on Control Systems
Technology, 17(1), 233241.
Luca, A. D., & Oriolo, G. (2002). Trajectory planning and control for planar robots
with passive last joint. The International Journal of Robotics Research, 21(56),
575590.
Nasrallah, D. S., Michalska, H., & Angeles, J. (2007). Controllability and posture
control of a wheeled pendulum moving on an inclined plane. IEEE Transactions
on Robotics, 23(3), 564577.
Pathak, K., Franch, J., & Agrawal, S. K. (2005). Velocity and position control of a
wheeled inverted pendulum by partial feedback linearization. IEEE Transactions
on Robotics, 21(3), 505513.
Salerno, A., & Angeles, J. (2003). On the nonlinear controllability of a quasiholonomic
mobile robot. In Proc. IEEE int. conf. robotics and automation (pp. 33793384).
Salerno, A., & Angeles, J. (2004). The control of semi-autonomous two-wheeled
robots undergoing large payload-variations. In Proc. IEEE int. conf. robotics and
automation (pp. 17401745).
Zhang, M., & Tarn, T. (2002). Hybrid control of the pendubot. IEEE/ASME Trans.
Mechatronics, 7(1), 7986.