Beruflich Dokumente
Kultur Dokumente
and
Masahiro Kaneda
I. I NTRODUCTION
The Acrobot, which is a two link planar robot with single
actuator at the joint of two links, has been studied as a
typical example of underactuated mechanical systems, see
e.g., [1], [2], [5], [8], [10]. Many research results have been
reported on the swing up control problem for the Acrobot,
i.e., to swing the Acrobot from the downward equilibrium
point to the upright equilibrium point and balance it about
the vertical [10]. For solving such problem, the approach of
combining the partial linearization control for the swinging
up phase and the LQR controller for the balancing phase
was proposed in [10]. An energy based swing up algorithm
was also proposed for the swinging up phase in [10];
however, strict analysis of the energy or the motion of the
Acrobot was not provided there. A difculty as indicated
in [10] is to tune the control parameters to accomplish the
capture and balancing phase successfully.
To overcome such difculty motivated us to study
whether there exists a controller under which the Acrobot
can be swung up to an arbitrarily small neighborhood of the
upright equilibrium point; this guarantees that the capture
and balancing phase can be easily accomplished.
On the other hand, [3] and [7] reported interesting energy
based control solutions to the swing up control problem
of the Pendubot, which is a two link planar robot with
single actuator at the shoulder (link 1) [9]. The solution
provided in [3] requires that the initial state of the Pendubot
This work is supported in part by Grant-in-aid for Encouragement of
Young Scientists.
Xin Xin and Masahiro Kaneda are with Department of
Communication Engineering, Faculty of Computer Science and
System Engineering, Okayama Prefectural University, 111 Kuboki,
Soja, Okayama 719-1197, JAPAN. xxin@c.oka-pu.ac.jp,
kaneda@c.oka-pu.ac.jp.
704
(1)
c1 + c2 + 2c3 cos q2 c2 + c3 cos q2
,
(2)
c2 + c3 cos q2
c2
h1
2q1 q2 q22
C(q, q)
q =
= c3
sin q2 , (3)
h2
q12
1
c4 g cos q1 + c5 g cos(q1 + q2 )
G(q) =
, (4)
=
2
c5 g cos(q1 + q2 )
=
l c1
l2
Fig. 1.
(11)
d11
0
=
(12)
I1 , m1
q1
I2 , m2
q2
(10)
kD
lc2
(9)
l1
E 2(c4 + c5 )g.
(13)
d11
c1 + c2 + 2c3 cos q2
min
:= .
2
q2 [0, 2] c1 c2 c3 cos2 q2
(14)
Next, we have
The Acrobot.
Note that the equalities in (13) and (14) are not satised
simultaneously. Therefore, we obtain kE E + kD d11 / >
2kE (c4 + c5 )g + kD . This gives that if
kD
2(c4 + c5 )g/
kE
(15)
(kV q2 + kP q2 )
kE E + kD d11
kD (d21 (h1 + 1 ) + d11 (h2 + 2 ))
. (16)
kE E + kD d11
1
1
1
2
2
2
q
q
2
2
(8)
V = kE E + kD q2 + kP q2 ,
2
2
2
(17)
where kE , kD , and kP are positive constants. If we can where q2 and E are constants and are convergent values
nd 2 such that limt E = 0 and limt q2 = 0 hold, of q2 and E, respectively.
Proof: From (10), let M be the largest invariant set in
then it is easy to see the Acrobot can be swung up to an
arbitrarily small neighborhood of the upright equilibrium the set of all points (q1 , q1 , q2 , q2 ) satisfying V = 0. Then
using LaSalles theorem [6], we know that every solution
point.
705
B(q2 )
(c2 c4 + 2c3 c5 ),
(28)
q2 q2 ,
c4 g cos q1 + c5 g cos(q1 + q2 ) = 0,
(q1 , q2 ) = (/2, 0)
(19)
(mod 2).
(20)
(22)
(23)
d21 q1 +
(24)
c3 q12
sin q2
+ c5 g cos(q1 +
q2 )
2 .
It is worth mentioning that d11 (q2 ) and d21 (q2 ) are constant. Obtaining q1 follows from (23) as
q1 = [c4 g cos q1 + c5 g cos(q1 + q2 )]/d11 ,
(25)
(26)
+2c3 q1 sin q2 c5 g sin(q1 + q2 ) = 0.
and
B(q2 ) = 0
(30)
(31)
(18)
(mod 2)
(32)
(33)
(34)
706
2(c4 + c5 )g
(1 sin q1 ),
c1 + c2 + 2c3
q2 0,
(35)
and
2
(c2 c4 + c3 c4 c1 c5 c3 c5 )g cos q1
,
c1 + c2 + 2c3
as t .
(36)
ii). The solution of the closed-loop system converges
to the downward equilibrium point (q1 , q1 , q2 , q2 ) =
(/2, 0, 0, 0), which is an unstable equilibrium point of
the closed-loop system.
Proof: Under the control law (16), from Lemma 1, E
is convergent to E .
i). For the case of E = 0, we obtain q2 = 0 from (9).
We can obtain (35) and (36) by putting E = E = 0 and
q2 = q2 = 0 into (17) and (16), respectively. This shows
the statement i).
ii). Consider the case E = 0. It follows from Lemma
1 and Proposition 1 that q1 , q2 are convergent to some
constants q1 and q2 , respectively. In what follows is
dropped for simplicity.
We shall investigate the solutions of (19) and (22). Dene
c4
kP
, =
.
c5
c4 c5 g 2 kE
We rewrite (19) and (22) as
cos q1 + cos(q1 + q2 ) = 0,
q2 + ( + 1 Gy ) cos q1 = 0,
(37)
(38)
(39)
G2y = 2 ,
where
(q2 ) =
1 + 2 + 2 cos q2 0.
((q2 ) + + 1) sin q2
.
(q2 )q2
q2 =0
(44)
(49)
(50)
Case ii. Gy =
In this case, the CM of the Acrobot is above the horizontal. From (42), we obtain
cos q1 = sin(q2 )/(q2 ).
(51)
((q2 ) 1) sin q2
.
(q2 )q2
(52)
(53)
(45)
(48)
(43)
(47)
sup (q2 ) = 2;
Gy cos q1 = sin q2 .
4
4
< <2
( + 1)
(54)
707
-5
-10
50
100
150
200
250
300
-1
0
5
50
100
150
200
250
300
50
100
150
200
250
300
50
100
150
200
250
300
q 1 dot
E
q 1 - /2
1 , 0,
2 , 0) near the DEP, where
21 +
22 > 0. Let E and
Edown be the energies of the Acrobot at the above state and
at the DEP, respectively. From (7), we have
(c1 + c2 + 2c3 )
22 /2 (c4 + c5 )g(cos
1 + 1)
V. S IMULATION R ESULTS
The validity of the developed theoretical results is veried
via numerical simulation investigation to three types of the
Acrobot described in [1], [5], [10]. Here we only introduce
our numerical simulation results for the Acrobot in [10],
where m1 = 1[kg], m2 = 1[kg], l1 = 1[m], l2 = 2[m],
lc1 = 0.5[m], lc2 = 1[m], I1 = 0.083[kgm2 ], I2 =
0.33[kgm2 ] and g = 9.8[m/s2 ].
Numerical computation of in (14) yields = 0.8578.
For an initial condition q1 (0) = 8/9, q2 (0) = 0, q1 (0) =
0, q2 (0) = 0, we choose kE = 0.5, kV = 45, and according
to (15) and (34), we choose kD = 2(c4 + c5 )kE / =
14.2804, kP = 2c4 c5 g 2 kE = 144.0600.
The simulation results under controller (16) with the
above control parameters are depicted in Figs. 2 and 3.
From Fig. 2, we know that q2 converges to 0, and link
q 2 dot
-2
Fig. 2.
0
-20
-40
50
50
100
150
200
250
300
10
5
0
-5
-10
5
q 1 dot
1 , 0,
2 , 0) < V (/2, 0, 0, 0) holds no matter how small
the
is. Note V is non-increasing under the control law (16),
then starting from (q1 , q2 , q1 , q2 ) = (/2 +
1 , 0,
2 , 0),
the motion of the Acrobot will not converge to the DEP,
but converge to the set M0 described in (35). This shows
the DEP is unstable.
According to Proposition 2, since the Acrobot can not be
maintained at the DEP in practice, and from the homoclinic
orbit (35), then the Acrobot starting from any initial state,
will eventually be swung up to an arbitrarily small neighborhood of the upright equilibrium point, where the controller
can be switched to any locally stabilizing one. Therefore,
the objective of the swing up control for the Acrobot can
be achieved under the conditions shown in Proposition 2.
Finally, we present the following remarks.
Remark 2: The key point in the proof of Proposition 2
is to show that if 2 holds, then (38) (describing the
equilibrium points of the Acrobot) and (39) have only the
solution given by (41), where the elucidation of Cases i and
ii is interesting.
Remark 3: Note that the assumption on the mechanical
parameters needed in [12] is that none of (A4), (A5) and
(31) holds. Such assumption is not needed here. Also,
the condition 2 in this paper is weaker and much
simpler than the corresponding one provided in [12],
where > max{supq2 (0,) (q2 ), supq2 (,2) (q2 )} was
expressed, and the numerical computation was suggested.
-5
0
2
100
150
250
200
300
-5
-8
Fig. 3.
-6
-4
q 1 - /2
-2
708
R EFERENCES
[1] M. D. Berkemeier and R. S. Fearing, Tracking fast inverted trajectories of the underactuated Acrobot, IEEE Transactions on Robotics
and Automation, vol. 15, pp. 740-750, 1999.
cos q2 = 0 ,
(A1)
cos q2 = 1,
(A2)
cos q2 = 1,
(A3)
c1 c5 c3 c4 ,
(A6)
(q2 )
> 0.
q2 > 0.
(B1)
=
=
sup
n
sup
q2 ((2n1),2n)
sup
q2 (,2)
(q2 )
(q2 ).
q2 (,2)
sup
q2 (2(n1),(2n1))
q2 =0
(q2 )
2(1 cos q2 )
1
| cos q1 | sup
.
q2 (,2) ( + 1 + )
q2 (,2) q2
sup
709