You are on page 1of 4

IEEE TRANSACTIONS ON FUZZY SYSTEMS, VOL. 12, NO.

4, AUGUST 2004 549

Letters__________________________________________________________________________________________
Acrobatic Control of a Pendubot
Wei Li, Kazuo Tanaka, and Hua O. Wang

Abstract—This paper presents acrobatic control of an underactuated


two-link robot called the pendubot. To achieve acrobatic control for the
pendubot, we design a fuzzy controller for keeping first link swinging
periodically while the second link maintains standing vertically. To facil-
itate the controller design, we represent the pendubot dynamics with a
Takagi–Sugeno fuzzy model. We derive a linear matrix inequality (LMI)
design condition to realize the acrobatic behavior. To accomplish the
numerical feasibility design, we need to select carefully reference fuzzy
model dynamics by taking into account some constraints. After selecting
reference fuzzy model dynamics, an acrobatic controller is designed by
solving the LMI condition. Simulation results show the utility of the
proposed acrobatic control.
Index Terms—Acrobatic control, linear matrix inequality (LMI) design
conditions, pendubot, Takagi–Sugeno fuzzy model.

Fig. 1. Pendubot.
I. INTRODUCTION
The two-link underactuated robotic mechanism called the pendubot Takagi–Sugeno fuzzy model [20]. Once fuzzy model is obtained, the
is widely used for research in nonlinear control and for education in parallel distributed compensation provided in [17] and [19] is carried
various concepts like nonlinear dynamics, robotics and control system out to design controllers. We derive a linear matrix inequality (LMI)
design [2]. Numerous control strategies have been proposed to bring the design condition to realize acrobatic behavior. To accomplish the nu-
mechanism to the upright position, such as partial feedback lineariza- merical feasibility design, we need to select carefully reference fuzzy
tion techniques [3] and energy-based approach [2]. Intelligent controls model dynamics by taking into account some constraints. After se-
for similar underactuated robots have been addressed. Sanchez et al. lecting reference fuzzy model dynamics, an acrobatic controller is de-
[6], [7] realized underactuated robot swing-up control via fuzzy con- signed by solving the LMI condition. Simulation results show the ef-
trol. Brown and Passino [8] discussed intelligent control of swing up fectiveness of the proposed acrobatic control.
and balancing control of an acrobot. The main topics of these papers
are swing up control and balancing (stabilizing) control at the upright II. PENDUBOT SYSTEM DYNAMICS
position. This paper will present a new control technique from another
Fig. 1 shows the pendubot. The pendubot system consists of two link,
point of view. It is realization of acrobatic behavior, e.g., keeping first
with an actuator at the shoulder (link 1) and no actuator at the elbow
link swinging periodically, while the second link maintains standing
(link 2). Link 2 moves freely around link 1 [2]. m1 and m2 are the
vertically. A number of literature have been reported the swing up and
masses of link 1 and link 2. 1 is the torque applied on link 1. q1 the
balancing control. To our knowledge, acrobatic control of the pendubot
angle that link 1 makes with the horizontal, q2 the angle that the link
or similar underactuated robots has not been discussed in the literature.
2 makes with link 1, l1 and l2 the lengths of link 1 and link 2, lc1 , lc2
In this paper, we employ Takagi–Sugeno fuzzy model-based control
the distance to the center of mass of link 1 and link 2, I1 and I2 the
to realize the acrobatic control. Recently, nonlinear control based on
moments of inertia of link 1 and link 2 about their centroids.
Takagi–Sugeno fuzzy systems have been discussed in a huge amount
We introduce the following five parameters: 1 = m1 lc21 + m2 l12 +
of literature [4]–[19]. These have considered typical regulation prob-
I1 , 2 = m2 lc22 + I2 , 3 = m2 l1 lc2 , 4 = m1 lc1 + m2 l1 , and
lems, i.e., stabilization at an equibulium point. However, to achieve the
5 = m1 lc2 . Considering standard assumption, i.e., no friction, we
acrobatic control, we need to design a controller so as to follow a given
have the nonlinear equations of motion as
reference model dynamics that generates acrobatic behavior. Since the
1 2
q1 =
pendubot is an underactuated system in addition to a nonlinear system,
acrobatic control design becomes complicated in general. This paper 1 2 0 32 cos q2 2 [2 3 sin q2(q_1 + q_2)
2 2
gives a simple and natural control technique to realize the acrobatic + 3 cos q2 sin (q2 )q_1
control.
In this paper, we design an acrobatic controller to keep the first link
+ 2 4 g sin q1 0 0
3 5 g cos q2 sin (q1 + q2 ) 2 1 ]; (1)
swinging while the second link maintains standing vertically. To facil- q2 =
1
0
1 2 32 cos q2 2
0
[ 3 (2 + 3 cos q2 ) sin q2 (q_1 + q_2 )
2

itate the controller design, we represent the pendubot dynamics with a


0 2
(1 + 3 cos q2 )3 sin q2 q_1
Manuscript received September 4, 2003; revised May 31, 2004. 0 (2 + 3 cos q2)(4 g sin q1 0 1)
W. Li and K. Tanaka are with the Department of Mechanical Systems and
Intelligent Systems, The University of Electro-Communications, Tokyo 182- + (1 + 3 cos q2 )5 g sin (q1 + q2 )]: (2)
8585, Japan (e-mail: liwei@rc.mce.uec.ac.jp; ktanaka@mce.uec.ac.jp).
H. O. Wang is with the Department of Aerospace and Mechanical Engi- In this paper, we suppose link 1 and link 2 are the same, and set param-
neering, Boston University, Boston, MA 02215 USA (e-mail: wangh@bu.edu). eters as m = 1, l = 1, lc1 = 0:5, g = 9:8, and I = (1=12)ml2 =
Digital Object Identifier 10.1109/TFUZZ.2004.832540 1=12.

1063-6706/04$20.00 © 2004 IEEE


550 IEEE TRANSACTIONS ON FUZZY SYSTEMS, VOL. 12, NO. 4, AUGUST 2004

III. ACROBATIC CONTROL and it is a Hurwitz matrix, then limt!1 e(t) = 0. It is generally hard
to solve (11) for F i and K k . Hence, we take a simple and practical
Our control objective is not the regulation problem, which is one
strategy of determining F i and K k such that the error system (8) is
of typical problems in control engineering. In this paper, we deal with
stabilized. Note that the condition can be converted into the following
acrobatic control that is an interesting nonstandard control problem.
condition:
The original system can be represented as
r kGij 0 H ijk k  (12)
q_ (t) = hi (q(t))(Aiq (t) + B iu(t)) (3)
i=1 for i < j s.t hi \ hj 6= , where is zero. The notation, i < j s.t
where q (t) = [q1 (t) q_1 (t) q2 (t) q_2 (t)]T denotes the states of hi \ hj 6= , means that all i < j excepting hi (q(t)) 2 hj (q(t)) = 0.
the system. The membership functions satisfy hi (q (t))  0 and The aforementioned condition is equivalent to (Gij 0H ijk )T (Gij 0
r hi (q (t)) = 1. The construction from the original model will be
i=1 H ijk )  II for i < j s.t hi \ hj 6= . By multiplying the previous
addressed later. inequality on the left and right by X = P 01 > 0, we obtain
We use the following reference model to achieve acrobatic control:
r X (Gij 0 H ijk )T (Gij 0 H ijk )X  2X X : (13)
q_ R (t) = vk (q R (t))D k q R (t) (4)
k=1 Assume that X > I . Then, (13) holds if
where q R (t) = [qR1 (t) q_R1 (t) qR2 (t) q_R2 (t)]T denotes the states of
the reference model. As well as in the fuzzy model, the membership
X (Gij 0 H ijk )T (Gij 0 H ijk )X  II (14)
functions satisfy vk (q R (t))  0 and rk=1 vk (q R (t)) = 1. Assume
that e(t) = q (t) 0 q R (t), then from (3) and (4), the error system is where = 2 .
From the above condition and the fact that Gij should be a Hurwitz
e_ (t) = q_ (t) 0 q_ R (t) matrix, we define the design problem as follows.
r r Find X > I and M i , N k (i; j; k = 1; 2; . . . ; r ) satisfying the
= hi (q (t))vk (qR (t))[(Aiq (t)+B iu(t)) 0D k q R (t)]: second equation shown at the bottom of the page, where X = P 01 ,
i=1 k=1 M i = F iX , and N k = K k X . The design problem consists of two
(5) sets of LMIs. The first LMI guarantees the stability of the error system
Consider the input as follows: (8). The second LMI is derived from the condition (11). In this way, we
r r can calculate the feedback gains F i and K k . The symbol 3 denotes the
transposed elements (matrices) for symmetric positions. If is zero,
u ( t) = 0 hi (q (t))F iq (t) + vk (q R (t))K k q R (t): (6)
i=1 k=1 the control purpose is perfectly achieved. However, if is extremely
small, the control purpose is realized in practice.
The controller design is to determine F i and K k to stabilize the In acrobatic control, a freedom of selecting D k exists. A wrong se-
error system (5). Substituting (6) into (5), the overall control system is lection of D k causes a problem that cannot minimize enough. To
represented as minimize as much as possible, we should carefully select D k . We
r r need to select D k by comparing the elements of Gij with those of H ijk
e_ (t) = hi (q (t))hj (q (t))(Ai 0B iF j )q (t) for i < j s.t hi \ hj 6= . Also, H ijk should be a Hurwitz matrix. In
i=1 j =1 other words, (D k ; (B i + B j )=2) is at least stabizable for all i, j and
r r
0 hi (q (t))vk (qR (t))2 (D k 0B iK k )q R (t): (7)
k . Thus, we should carefully choose D k , so that it is possible to satisfy
those conditions simultaneously.
i=1 k=1
As shown in (1) and (2), the pendubot system has strong nonlin-
It can be rewritten as (8), as shown at the bottom of the page, where earity. So, we choose local approximation [1] to obtain a fuzzy model
Gij =
Ai 0 B iF j + Aj 0 B j F i ; (9)
in fuzzy partition spaces. The spirit of the approach is to approximate
2 nonlinear terms by judiciously choosing linear terms. This procedure
H ijk = D k 0 B i + B j K k : (10)
leads to reduction of the number of model rules, which directly results
2 in simplification of analysis and design LMI conditions.
If As illustrated in Fig. 1, for keeping the second link upright at any
time, we have equation qR1 (t) + qR2 (t) = 0 as a constraint, which
Gij = H ijk ; i; j = 1; 2 . . . r; k = 1; 2 . . . rR (11) also means that q_R1 (t) + q_R2 (t) = 0 and qR1 (t) + qR2 (t) = 0 hold.

r r r
e_ (t) = hi (q (t))hj (q (t))vk (qR (t)) 2 [Gij q (t) 0 H ijk q R (t)] (8)
i=1 j =1k=1

minimize subject to X > I ; > 0; 0AiX 0 X ATi 0 Aj X 0 X ATj + B j M i + M Ti B jT + B iM j + M Tj B iT  0;


i < j s:t hi \ hj 6= 
II 12 [(AiX 0 B iM j + Aj X 0 B j M i ) 0 (2Dk X 0 (B i + B j )N k )]T
> 0;
3 I
i < j s:t hi \ hj =6 
IEEE TRANSACTIONS ON FUZZY SYSTEMS, VOL. 12, NO. 4, AUGUST 2004 551

Following the procedure stated in [1], we can have the following


fuzzy model:
Model Rule 1 : IF q1 (t) is 0; and q_1 (t) is c1 ;
THEN q_ (t) = A1q (t) + B 1 1 (t)
Model Rule 2 : IF q1 (t) is 0; and q_1 (t) is c2 ;
THEN q_ (t) = A2q (t) + B 2 1 (t)
Model Rule 3 : IF q1 (t) is 6 ; and q_1 (t) is c1 ;
THEN q_ (t) = A 3q (t) + B 3 1 (t)
Model Rule 4 : IF q1 (t) is 6 ; and q_1 (t) is c2 ;
THEN q_ (t) = A 4q (t) + B 4 1 (t):
Where c1 , c2 , and  are constants, c1 > 0, c2 < 0, jc1 j 6= jc2 j, and
the equation shown at the bottom of the page holds. It is considerably
important to choose c1 and c2 . The bigger q_1 is, the higher the swinging
frequency becomes, and the harder control turns to be. In this paper,
c1 = 0:5, c2 = 00:4, and  = 10 . Note that jq (0)j ; jq R (0)j 
min jc1 j; jc2 j. Fig. 2 illustrates the membership functions of q1 (t) and
q_1 (t). We employ the following reference fuzzy model: Fig. 2. Membership functions of q (t) and q_ (t).

Reference Rule 1 : IF qR1 (t) is 0; and q_R1 (t) is c1 ;


0 1 0 0
THEN q_ R (t) = D 1q R (t) 10:0 8 :0 10:25 8 :0
D3 =
Reference Rule 2 : IF qR1 (t) is 0; and q_R1 (t) is c2 ; 0 0 0 1
THEN q_ R (t) = D 2q R (t) 010:15 019:82 010:4 019:82
Reference Rule 3 : IF qR1 (t) is 6 ; and q_R1 (t) is c1 ; 0 1 0 0
10:0 8 :0 10:0 8 :0
THEN q_ R (t) = D 3q R (t) D 4= :
Reference Rule 4 : IF qR1 (t) is 6 ; and q_R1 (t) is c2 ;
0 0 0 1
010:15 019:82 010:31 019:82
THEN q_ R (t) = D 4q R (t)
Note that r = rR and hi (x) = vi (x) for any x . Fig. 3 shows state re-
sponses for the original system (1) and (2), where q (0) = [5 ; 0; 05 ; 0]
0 1 0 0

D1 =
10:0 3 :0 10:25 3 :0
and q R (0) = [5 ; 0:1; 05 ; 00:1]. The state responses of the pendubot
0 0 0 1 system approach those of the reference system in 10 seconds. The de-
010:3 07:5 010:55 07:5 signed fuzzy controller works effectively. Frequency and amplitude of
0 1 0 0 state responses depend on the initial states of q R . So by setting values
10:0 6 :0 10:16 6 :0 of q R (0), we can obtain various system response. However, considering
D2 =
0 0 0 1 pendubot as a physical system, we should choose those initial values,
010:3 015 010:46 015 which satisfy certain dynamic constraints.

0 1 0 0
   
g0 (c    0 g)
A1 =    0 0    0 0
0 0 0 1
( + ) 0
( + )
g
( + )( g 0c  )
   0 0    0 0
0 1 0 0
   
g0 (c  0
  g)
A2 =    0 0    0 0
0 0 0 1
( + ) 0
( + )
g
( + )( g 0c  )
   0 0    0 0
0 1 0 0
  0  cos  sin  g 0
c    g sin 2
A3 =   0 cos   0 0
   cos  2
0
0 0 0 1

  0
g
cos 
[(1 + 3 cos  )5 0 ( 2 + 3 cos  )4 ] 0   0 cos 
[(1 + 3 cos  )(5 g 0 c  )]
2
1 3 0
0 1 0 0
  0  cos  sin  g 0
c    g sin 2
A4 =   0 cos   0 0
   cos  2
0
0 0 0 1

  0
g
cos 
[(1 + 3 cos  )5 0 ( 2 + 3 cos  )4 ] 0   0 cos 
[(1 + 3 cos  )(5 g 0 c  )]
2
2 3 0
0 0
0 0
B1 = B2 =   0 B3 = B4 =   0 cos  :
0 0
 +  + cos 
  0   0 cos 
552 IEEE TRANSACTIONS ON FUZZY SYSTEMS, VOL. 12, NO. 4, AUGUST 2004

[12] M. Sugeno, “On stability of fuzzy systems expressed by fuzzy rules with
singleton consequents,” IEEE Trans. Fuzzy Syst., vol. 7, pp. 201–224,
Apr. 1999.
[13] S. Hong and R. Langari, “Synthesis of an LMI-based fuzzy con-
trol system with guaranteed optimal H performance,” in Proc.
FUZZ-IEEE’98, Anchorage, AK, May 1998, pp. 422–427.
[14] D. Filev, “Algebraic design of fuzzy logic controllers,” in Proc. 1996
IEEE Int. Symp. Intelligent Control, Dearborn, MI, Sept. 1996, pp.
253–258.
[15] T. Furuhashi et al., “Fuzzy control stability analysis using generalized
fuzzy petri net model,” J. Adv. Comput. Intell., vol. 3, no. 2, pp. 99–105,
1999.
[16] H. Yamamoto and T. Furuhashi, “New fuzzy inference method for sym-
bolic stability analysis of fuzzy control systems,” in Proc. 9th IEEE Int.
Conf. Fuzzy Systems, San Antonio, TX, May 2000, pp. 659–664.
[17] H. O. Wang, K. Tanaka, and M. Griffin, “Parallel distributed compen-
sation of nonlinear systems by Takagi and Sugeno’s fuzzy model,” in
Proc. FUZZ-IEEE’95, Yokohama, Japan, Mar. 1995, pp. 531–538.
[18] S. G. Cao, N. W. Rees, and G. Feng, “Analysis and design of a class
of continuous time fuzzy control systems,” Int. J. Control, vol. 64, pp.
1069–1087, 1996.
[19] H. O. Wang, K. Tanaka, and M. Griffin, “An approach to fuzzy control
Fig. 3. State responses for original system (1) and (2). of nonlinear systems: Stability and design issues,” IEEE Trans. Fuzzy
Syst., vol. 4, pp. 14–23, Feb. 1996.
[20] T. Takagi and M. Sugeno, “Fuzzy identification of systems and its appli-
cations to modeling and control,” IEEE Trans. Syst. Man Cybern., vol.
IV. CONCLUSION 15, pp. 116–132, Jan. 1985.
This paper has presented acrobatic control of an underactuated two-
link robot called the pendubot. To achieve acrobatic control for the pen-
dubot, we have designed a fuzzy controller for keeping first link swinging
periodically while the second link maintains standing vertically. We have Intelligent Tracking Control for Robot Manipulator
derived an LMI design condition to realize acrobatic behavior. To ac- Including Actuator Dynamics via TSK-Type
complish the numerical feasibility design, we need to select carefully ref- Fuzzy Neural Network
erence fuzzy model dynamics by taking into account some constraints.
After selecting reference fuzzy model dynamics, an acrobatic controller Rong-Jong Wai and Po-Chen Chen
has been designed by solving the LMI condition. Simulation results have
shown the utility of the proposed acrobatic control. A next subject of our
study is to apply this control technique to the real pendubot system. Abstract—In this paper, a Takagi–Sugeno–Kang-type fuzzy-neural-net-
work control (T-FNNC) scheme is constructed for an -link robot
manipulator to achieve high-precision position tracking. According to
REFERENCES the concepts of mechanical geometry and motion dynamics, the dynamic
model of an -link robot manipulator including actuator dynamics is
[1] K. Tanaka and H. O. Wang, Fuzzy Control Systems Design and Anal- introduced initially. However, it is difficult to design a suitable model-based
ysis. New York: Wiley, 2000. control scheme due to the uncertainties in practical applications, such as
[2] I. Fantoni, R. Lozano, and M. W. Spong, “Energy based control of the friction forces, external disturbances and parameter variations. In order
pendubot,” IEEE Trans. Automat. Contr., vol. 45, pp. 725–729, Apr. to cope with this problem, a T-FNNC system without the requirement of
2000. prior system information and auxiliary control design is investigated to the
[3] M. W. Spong and D. J. Block, “The pendubot: A mechatronic system joint position control of an -link robot manipulator for periodic motion.
for control research and education,” in Proc. 34th IEEE Conf. Decision In this model-free control scheme, a five-layer fuzzy-neural-network is
Control, 1995. utilized for the major control role, and the adaptive tuning laws of network
[4] K. Tanaka and M. Sugeno, “Stability analysis of fuzzy systems using parameters are established in the sense of projection algorithm and
Lyapunov’s direct method,” in Proc. NAFIPS’90, Toronto, ON, Canada, Lyapunov stability theorem to ensure the network convergence as well as
June 1990, pp. 133–136. stable control performance. In addition, experimental results of a two-link
[5] R. Langari and M. Tomizuka, “Analysis and synthesis of fuzzy linguistic robot manipulator actuated by dc servomotors are provided to verify the
control systems,” in Proc. 1990 ASME Winter Annu. Meeting, Dallas, effectiveness and robustness of the proposed T-FNNC methodology.
TX, Nov. 1990, pp. 35–42.
[6] E. N. Sanchez et al., “Fuzzy PD scheme for underactuated robot Index Terms—Adaptive tuning algorithm, dc servomotors, Lyapunov
swing-up control,” in Proc. 1998 IEEE World Congr. Computational stability theorem, robot manipulator, Takagi–Sugeno–Kang (TSK)-type
Intelligence, Anchorage, AK, 1998, pp. 302–307. fuzzy-neural-network.
[7] , “Real time fuzzy swing-up control for an underactuated robot
fuzzy logic based real-time navigation controller for a mobile robot,”
in Proc. 1998 Joint Conf. Information Science, Reseach Triangle Park, I. INTRODUCTION
NC, 1998, pp. 167–170.
[8] S. C. Brown and K. M. Passino, “Intelligent control for an acrobot,” J. Over the past decade, the applications of intelligent control tech-
Intell. Robot. Syst., vol. 18, pp. 209–248, 1997. niques (fuzzy control or neural-network control) to the motion control
[9] S. Kitamura and T. Kurozumi, “Extended circle criterion and stability of robotic manipulators have received considerable attention [1]–[4].
analysis of fuzzy control systems,” in Proc. International Fuzzy Engi-
neering Symp., vol. 2, Yokohama, Japan, Nov. 1991, pp. 634–643. Manuscript received October 2, 2003; revised March 14, 2004. This work
[10] K. Tanaka and M. Sugeno, “Stability analysis and design of fuzzy control was supported by the National Science Council, R.O.C., under Project NSC
systems,” Fuzzy Sets Syst., vol. 45, no. 2, pp. 135–156, 1992. 92-2213-E-155-030.
[11] S. S. Farinwata et al., “Stability analysis of the fuzzy logic controller de- The authors are with the Department of Electrical Engineering, Yuan Ze Uni-
signed by the phase portrait assignment algorithm,” in Proc. of 2nd IEEE versity, Chung Li 32026, Taiwan, R.O.C.
Int. Conf. Fuzzy Systems, San Francisco, CA, Apr. 1993, pp. 1377–1382. Digital Object Identifier 10.1109/TFUZZ.2004.832531

1063-6706/04$20.00 © 2004 IEEE

You might also like