Beruflich Dokumente
Kultur Dokumente
www.elsevier.com/locate/fss
Robust fuzzy logic control of mechanical systems
Sylvia Kohn-Rich, Henryk Flashner
Department of Aerospace and Mechanical Engineering, University of Southern California, 3650 McClintock Avenue,
University Park, Los Angeles, CA 90089-1453, USA
Received 9 May 2000; received in revised form 15 January 2002; accepted 17 January 2002
Abstract
An approach for the design of fuzzy control laws for tracking control of a large class of mechanical
systems is proposed. The approach employs the framework of Lyapunovs stability theory to formulate a class
of control laws that guarantee convergence of the tracking errors to within specication limits in presence of
bounded parameter uncertainties and input disturbances. The proposed control laws possess a large number of
parameters and functional relationships to be chosen by the designer according to a methodology developed
in the paper. The large number of design degrees of freedom makes the approach suitable for fuzzy logic
implementation. A number of fuzzy implementations of the proposed control methodology are provided. All
implementations guarantee tracking error convergence to within prespecied performance limits. An extensive
simulation study using a model of a two-degree-of-freedom robot manipulator was conducted. Fuzzy and
non-fuzzy implementations of the proposed methodology were compared to control laws designed using other
design methods. Simulation study results indicate a superiority of the proposed control methodology compared
to other approaches. The study also demonstrates better performance of the fuzzy control implementation
compared to its non-fuzzy counterpart. c 2002 Elsevier Science B.V. All rights reserved.
Keywords: Fuzzy control; Mechanical systems; Robotics
1. Introduction
Since its inception by Zadeh [36], Fuzzy Logic Theory has attracted diehard supporters and an-
tagonists. In the context of control engineering, the former group advocates the universal aptness
of Fuzzy Logic Theory to all control problems based on its successful application to consumer ap-
pliances and industrial processes [35]. This success is due to the Fuzzy Logic systems ability to
provide explicit model-free control of complex plants (since the rules necessary for fuzzy operation
can be provided by an expert or an statistical system, such as Neural Networks, from training data),
Corresponding author.
E-mail address: hashne@almaak.usc.edu (H. Flashner).
0165-0114/02/$ - see front matter c 2002 Elsevier Science B.V. All rights reserved.
PII: S0165- 0114(02)00212- 9
78 S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108
their ability to adapt to conditions dierent from design, and the parallelization of their computa-
tions. The diehard antagonists of Fuzzy Logic Control (FLC) claim that conventional control based
on rigorous mathematics can outperform any FLC. However, in the last decade a third point of view
has emerged which seeks consensus from a synthesis of both methodologies.
The emerging hybrid control methodology combines the conventional control theory with soft-
computing theories to create controllers for dynamical systems [10]. An increasing amount of research
on integration of qualitative knowledge (for example, pilot experience) and quantitative knowledge
(analytical models) through fuzzy modeling and control has been applied to ight control laws for
helicopters [25, 12, 21], aircraft and spacecraft [9, 20] (see survey in [22]).
Mechanical systems with large uncertainties, non-linearities and bounded external disturbances have
been successfully controlled using Lyapunov-based robust controllers (see the survey in [15]). In the
past few years, the major focus of conventional mechanical systems research has been on robust and
adaptive controllers [18, 29, 30, 3] where a nominal model is assumed and uncertainty accounts for
all aspects of the system not accounted for by this nominal model. Some properties of the nominal
system and uncertainty are assumed, such as the boundedness of the inertia matrix, the structure of the
bound of the Coriolis}centrifugal forces, and the boundedness of the gravitational forces. Many such
controllers have been proposed in the last decade, for which the tracking errors converge to a given
manifold. In [18], a proportional-derivative (PD) plus robust non-linear decentralized (decoupled)
control law with constant coecients is proposed such that the error is globally convergent to a
residual set around a linear manifold. A similar controller is proposed in [29], and is later extended
to a non-linear manifold in [30] by requiring exact knowledge of the nominal dynamic equations. In
[3], a robust controller also requiring knowledge of all the nominal dynamic equations is designed
such that the error converges to a linear manifold and the closed-loop system is uniformly ultimately
bounded. All these controllers have a boundary layer around the error manifold, where the control
eort obeys dierent rules in order to avoid chattering.
Considerable research eort has been directed toward laying the foundation of a systematic design
methodology of FLC systems [34]. In the last decade, there have been several research directions
in Fuzzy Logic Control. One deals with modeling and stability of TakagiSugenoKang (TSK)
linear-time-varying type systems using Lyapunov Linear Matrix Inequalities and H
methodologies
[28, 27, 16, 24, 11]. The corresponding control strategy is closely related to traditional gain schedul-
ing. Another research direction deals with stability of PID-like Fuzzy Logic Controllers (PID-FLCs)
[8, 33, 4] based on classical control theory techniques. Most methodologies used for the design of
membership functions are either intuitive or rely on nding local equivalent PID gains for the PID-
FLC. A third research direction focuses on the application of Lyapunov, variable structure (Sliding
Mode) and adaptive control techniques to non-linear systems for which the nominal dynamics (ana-
lytic functions or TSK models) and the bounds on the model uncertainties are known [31, 19, 2, 26].
In a Sliding Mode Controller, application of Lyapunovs Stability Theory guarantees that the tracking
error remains close to the error manifold (sliding surface).
This paper presents a new robust control design approach for tracking control of mechanical
systems. The approach is based on Lyapunov Stability Theory and extends the work of Corless and
Leitmann [6] on robust control of nonlinear systems. It also extends the work of Efrati and Flashner
[7]. The proposed control law denes a large class of robust tracking controllers allowing a great
deal of exibility for the designer, thus making it appropriate for Fuzzy Logic implementation to
enhance the overall system performance. The importance of the new methodology is that it provides
S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108 79
a general procedure for the design of robustfuzzy hybrid (analog+fuzzy) control laws for a large
class of mechanical systems.
The paper is organized as follows. In Section 2, the characteristics of mechanical systems and
Input-to-State denition and theorem are presented. The Fuzzy Logic Controller (FLC) is presented
in Section 3. The new robust tracking law is formulated in Section 4, and the performance of the
proposed approach is demonstrated in a simulation example for a rotationalprismatic planar robot
arm in Section 5. Concluding remarks are given in Section 6.
2. Characteristics of mechanical systems
Consider the motion of an n-degrees-of-freedom mechanical system dened by the generalized
coordinates qR
n
. The equation of motion can be written as
M(q) q + C(q, q) + q(q) = Q + t
d
, (1)
where M(q)R
nn
is the symmetric positive-denite inertia matrix q, the inertial terms are rep-
resented by M(q) q, the Coriolis (centripetal) terms are represented by C(q, q) =
M(q) q
1
2
(c}cq)
( q
T
M(q) q), the potential terms are represented by q(q), Q is a control law and t
d
represents the
bounded disturbances.
The system described by Eq. (1) has the following properties:
1. The inertia matrix M(q) is bounded:
z
m
I 6M(q) 6z
M
I, (2)
where z
m
(z
M
) denotes the strictly positive minimum (maximum) eigenvalue of M for all
congurations of q.
2. The Coriolis and centrifugal terms C(q, q) satisfy
C(q, q) 6t
b
(q) q
2
, (3)
where t
b
(q) is a known scalar function. Since q is bounded for most practical engineering appli-
cations, t
b
(q)6t
b
for a constant t
b
0.
3. It is always possible to nd
C(q, q) such that
C(q, q) =
C(q, q) q (4)
and S =
1
2
M(q)
C(q, q) is skew-symmetric, i.e.
:
T
S(q, q): = 0 : R
n
. (5)
4. The gravity vector q(q) satises
q(q) 6q
0
(q), (6)
where q
0
(q) is known.
80 S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108
5. The system dynamics equation (1) can always be written as
Y(q, q, q)p = Q, (7)
where Y(q, q, q)R
nr
and pR
r
is a vector of dynamic parameters.
6. It is also assumed that the disturbances are bounded as follows:
t
d
6O. (8)
3. Structure of the proposed fuzzy logic controller
In this section, relevant terminology and results are presented. For a more detailed discussion
see [34].
The fuzzy membership functions are chosen to satisfy the normality requirement. The triangular
and Gaussian membership functions are used in this work, dened as
j
A
! (x) =
_
1 |x x
!
|}b
x
if |x x
!
| b
x
,
0 otherwise,
(9)
j
A
! (x) = e
((xx
!
)}a
x
)
2
, (10)
where ! =1, 2, . . . , N and the centers of the membership functions satisfy x
!
x
!+1
. The advantage of
Gaussian membership functions is that they are continuously dierentiable for all x.
The Fuzzy Logic Controller structure used has product inference engine, singleton fuzzier and
center average defuzzier, with the following form (see [34]):
[(x) =
M
!=1
,
!
(
n
i=1
j
A
!
i
(x
i
))
M
!=1
(
n
i=1
j
A
!
i
(x
i
))
, (11)
where xUR
n
is the input to the fuzzy system, and [(x)J R is the output of the fuzzy system.
4. Tracking control design procedure
In this section, a design approach for robust control of uncertain systems is proposed, based on
Lyapunov Stability Theory. This approach extends the works of Slotine [23] and later Leitmann and
Corless [6], to develop a control structure with great exibility, specially suitable for Fuzzy Logic
applications. It denes a general class of manifolds that can be used to achieve convergence of the
system trajectory to the neighborhood of the reference trajectory, while leaving considerable freedom
for shaping the behavior of the systems trajectory inside this neighborhood.
Control system designers have great freedom in the choice of functions s
c
and [(e) presented
in the following Proposition, allowing specic tailoring for the application at hand. In spite of the
inherent exibility, the closed-loop system is guaranteed to be robustly stable and has a guaranteed
rate of convergence to an error manifold.
S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108 81
4.1. Preliminary results
Denition 1 (Uniform exponential convergence to a manifold). The system x =[[t, x(t)] is said to
be uniformly exponentially convergent to within a radius r
B
of the manifold B(x) =0 i there exists
:
B
0 with the property that, for any initial conditions t
0
R and x
0
DR
n
, there exists c
B
(x
0
)0
such that, if x(.) is a solution of x =[[t, x(t)] with x(t
0
) =x
0
, then:
B(x(t)) 6r
B
+ c
B
(x
0
) exp[:
B
(t t
0
)] (12)
for all tt
0
. Moreover, if D=R
n
then the system is globally uniformly exponentially convergent to
within a radius r
B
of the manifold B(x) =0.
Denition 2 (Class K (KL) [13]). A continuous function : : [0, a) [0, ) is said to belong to
class K if it is strictly increasing and :(0) =0. It is said to belong to class K
if a = and
:(r) as r .
A continuous function [ : [0, a) [0, ) [0, ) is said to belong to class KL if, for each xed
s, the mapping [(r, s) belongs to class K with respect to r and, for each xed r, the mapping [(r, s)
is decreasing with respect to s and [(r, s) 0 as s .
Theorem 3 (Corless [5]). Suppose that for a system x =[[t, x(t)] xR
n
, t R
+
and a continuously
dierentiable function B(x) : R
n
R
n
, there exists a continuously dierentiable function J(x) : R
n
0, :
B
0 such that
t R:
dJ(x)
dt
62:
B
[J(x) J
]x s.t. J(x) J
. (14)
Then the system is uniformly exponentially convergent to within a radius r
B
of the manifold
B(x) =0 with rate :
B
, where
r
B
=
c
1
, (15)
c
B
(x
0
) ,
_
_
0 if J(x
0
) 6J
J(x
0
) J
c
1
if J(x
0
) J
.
(16)
4.2. Tracking control of mechanical systems
Consider a mechanical system described by Eq. (1) having characteristics given by Eqs. (2)(8).
The objective is to design a control Q such that the state : =[q q]
T
of the system follows the state of
82 S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108
a model system :
m
=[q
m
q
m
]
T
in the presence of parameter uncertainties and bounded disturbances.
It is assumed q
m
(t), q
m
(t)R
n
satisfy the equation
M
m
(q
m
) q
m
+
C
m
(q
m
, q
m
) q
m
+ q
m
(q
m
) = t
c
(17)
provided that
q
m
6w
m
1
and q
m
6w
m
2
. (18)
Proposition 4. Consider the system in Eq. (1) with the following control law:
Q = Q
L
+ Q
r
, (19)
Q
L
= K
d
B, (20)
Q
r
=
_
s(B) :
B}B
2
if B
2
c
s
c
if B
2
c
, cR
+
, c 6r
B
(21)
with denitions
e q q
m
, (22)
B e + [(e), (23)
:
z
M
q
m
c[
ce
e
2
+ t
b
q
2
2
+ q
0
+ O + pz
M
B
2
, (24)
s(B) [s
1
(B) s
n
(B)]
T
, (25)
[(e) [[
1
(e
1
) [
2
(e
2
) [
n
(e
n
)]
T
, (26)
where s
c
is an arbitrary function.
Function [(e) is a dieomorphism, K
d
and are constant diagonal positive-denite matrices,
p0 is a constant, and the following conditions are satised:
B
i
s
i
(B) 0, i = 1, . . . , n, (27)
[
i
(0) = 0,
d[
i
de
i
0, i = 1, . . . , n, (28)
k
[
(.), K
[
(.) class K functions: k
[
(e
2
) 6[(e)
2
2
6K
[
(e
2
). (29)
Assume that the initial conditions satisfy
q(0)
2
6w
1
,
q(0)
2
6r
+
t
+ w
m
2
6
z
min
(K
d
)
t
b
,
(30)
where w
1
0 is constant, z
min
(K
d
) is the minimum eigenvalue of K
d
and r
+
t
is a positive con-
stant that depends on design parameters and initial conditions. Assume also that condition (18) is
satised.
S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108 83
Then the closed-loop system has the following properties:
(i) The system converges exponentially to a manifold: B(e(t), e(t))
2
6r
B
+
B
exp(pt), where
B
and r
B
are positive constants that depend on design parameters and initial conditions.
(ii) The tracking error is input-to-state stable: e(t)
2
6[(e(0)
2
, t) +(sup
06t6t
B(t)
2
), where
[ is a class KL function and is a class K function.
Proof. Choose the following function:
E =
1
2
B
T
MB. (31)
Dierentiation with respect to time, substitution of Eqs. (1), (19) and (20) in denition (31) results
in
E = B
T
(
C q q K
d
B + Q
r
+ t
d
) B
T
M q
m
+ B
T
M
c[
ce
e +
1
2
B
T
MB. (32)
Using Eq. (5) it is obtained
1
2
B
T
M(q)B=B
T
C(q, q)B, and denoting [=M q
m
+
C q + q yields
E = B
T
_
Q
r
[ + M
c[
ce
e + t
d
_
B
T
(K
d
C)B. (33)
In order to establish positivity of the last term in the above, we need the matrix (K
d
C) to be
positive denite, then:
q
T
(K
d
C) q 0 q
T
K
d
q q
T
C q. (34)
From matrix properties we know that z
min
(K
d
) q
2
2
6 q
T
K
d
q6z
max
(K
d
) q
2
2
. Hence, using inequality
(3) it is obtained that B
T
(K
d
C)B0 if:
q(t)
2
z
min
(K
d
)
t
b
. (35)
The above inequality is satised provided that the initial conditions satisfy condition (30). Using
Eq. (33) we get
E 6B
T
_
Q
r
[ + M
c[
ce
e + t
d
_
. (36)
Property (i). Dene a state x[e e]
T
and apply inequality (2) to Eq. (31):
1
2
z
m
B
2
2
6
1
2
B
T
MB 6
1
2
z
M
B
2
2
. (37)
Condition (13) is satised for J E, with c
1
1
2
z
m
and c
2
1
2
z
M
. To satisfy condition (14), we
need
E 62p(E E
+
), (38)
where J
E
+
0 is a design parameter. From inequalities (36) and (38), we get
B
T
_
Q
r
[ + M
c[
ce
e + t
d
_
62p(E E
+
). (39)
84 S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108
Consider the control Q given in (19)(21) with
Q
r
= s(B) :
B
B
2
. (40)
Rearranging inequality (39) yields
_
z
M
q
m
c[
ce
e
2
+ t
b
q
2
2
+ q
0
+ O + pz
M
B
2
_
B
2
+ B
T
s(B)
B
T
_
M
_
q
m
c[
ce
e
_
+
C q + q t
d
_
+ pB
T
MB 2pE
+
. (41)
From properties (2), (3) and (6) it is obtained:
B
2
z
M
q
m
c[
ce
e
2
B
T
M
_
q
m
c[
ce
e
_
,
B
2
t
b
q
2
2
B
T
C q,
(q
0
+ O)B
2
B
T
(q t
d
),
pz
M
B
2
2
pB
T
MB. (42)
Hence, using condition (27) we have exponential convergence to the manifold B=0, according to
Theorem 3, with
r
B
=
E
+
c
1
=
2E
+
z
m
, (43)
B
=
_
_
0 if
1
2
z
M
B
0
2
2
6E
+
(1}2)z
M
B
0
2
2
E
+
(1}2)z
m
=
z
M
z
m
B
0
2
2
r
2
B
if
1
2
z
M
B
0
2
2
E
+
(44)
and parameter c satisfying
c 6r
B
c 6
2E
+
z
m
. (45)
Property (ii). Consider the system
e + [(e) = u(e, e) B e = B [(e). (46)
Choose the function
V=
1
2
[
T
(e)[(e). (47)
S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108 85
Then, condition (A.3) is satised by using condition (29). Dierentiating Eq. (47) and applying
Eq. (46) and denition (26) yields
V=
i=n
i=1
_
ii
[
2
i
d[
i
de
i
+ [
i
d[
i
de
i
B
i
_
. (48)
Using inequality (28) on condition (A.4) yields
ii
[
2
i
d[
i
de
i
[
i
d[
i
de
i
B
i
ii
[
2
i
[
i
B
i
for e
2
j(B
2
) 0. (49)
By requiring
ii
|[
i
|
2
=
ii
[
2
i
|[
i
| |B
i
| [
i
B
i
, |[
i
|
B
2
ii
|B
i
|
ii
, (50)
we get
|[
i
(e
i
)|
B
2
ii
e
i
[
1
i
_
B
2
ii
_
e
2
i
_
[
1
i
_
B
2
ii
__
2
(51)
and
e
2
i=n
i=1
_
[
1
i
_
B
2
ii
__
2
j(B
2
), (52)
satisfying condition (A.4) and proving Property (ii).
For the special case of a linear manifold B, we can prove exponential convergence of the tracking
error as follows.
Corollary 5. Consider the controller given by Eqs. (19)(26) and satisfying conditions (27)(30).
For
B e + e (53)
and
p z
max
() z
min
(), (54)
where z
min
() and z
max
() are the minimum and maximum eigenvalues of , we have
(c-i) e(t)
2
6r
e
+
e
exp(p
e
t),
(c-ii) e(t)
2
6r
t
+
t
exp(p
t
t),
where
e
, r
e
, p
e
, p
t
, r
t
, and
t
are positive constants that depend on design parameters and initial
conditions.
For proof, see [14].
86 S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108
Notes:
(i) The radius of convergence r
B
and c are design parameters.
(ii) Possible choices for s(B) in denition (21) are
s(B) = [0] R
n
, s
i
(B
i
) = K
i
B
i
. (55)
(iii) For B(x)
2
c the control is arbitrary. A possible choice is
Q
r
= s
c
s(B) :
c
B
c
for B(x)
2
c, (56)
thus satisfying continuity at B(x)
2
=c. Moreover, for B(x)
2
c the control law constitutes a PD
control logic with an additional dissipating term.
5. Tracking fuzzy logic controllers
In the following section, the performance of the proposed method is demonstrated using two Fuzzy
Logic implementations of the control law dened by the proposition in Section 4. The two designs
presented here are only a sample of possible implementations of the method proposed in this paper.
They demonstrate that the method provides the exible framework needed for fuzzy logic control
design. It leaves ample freedom for the implementation of control systems and allows to customize
the design to specic applications.
All control system implementations use the structure shown in Fig. 1. The dierent implementations
are described in the following.
Mechanical
System
Fuzzy Controller
n
R Q
n
R q
n
R q
Commanded nominal
trajectory
F
C
Model Mechanical
System
M
Torques driving the
model mechanical
system
P P +
n
m
R q
n
m
R q
n
c
R v
d
Disturbance
.
.
Fig. 1. Closed-loop fuzzy tracking control system.
S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108 87
5.1. Fuzzy manifold-boundary robust controller
In the fuzzy manifold-boundary robust controller implementation, Q
L
is a conventional PD control
law and Q
r
has a fuzzy component, see Eqs. (20) and (21).
From denition (21), we get that the control for Bc is given by an arbitrary function s
c
.
However, the choice of s
c
aects the transient response of the system. In particular, if s
c
=0 then
high-frequency chattering may occur. The controller in this section eliminates chattering by imple-
menting a fuzzy s
c
.
5.1.1. Design of Q
r
For B
2
c, Q
r
is implemented using Eq. (21) with s(B) =0. For B
2
6c, Q
r
is given by
Q
r
= s
c
= :
K
[
B
c
, (57)
where K
[
is the crisp output of a Fuzzy Logic Controller described as follows.
Step 1: Choice of membership functions. Dene
o
c
=
B
2
c
. (58)
Choose N fuzzy membership functions for o
c
. The centers of the membership functions satisfy:
o
!
c
0, o
!
c
61, o
!
c
o
!+1
c
. (59)
Step 2: Formulation of fuzzy rules. Formulate the IFTHEN rules of the form
IF o
c
is A
!
o
c
THEN K
[
is B
!
K
[
, (60)
where ! =1, 2, . . . , N. The centers of the THEN parts of the fuzzy sets B
!
K
[
, denoted by c
!
K
[
, are
chosen so that:
0 6o
c
c
!
K
[
61; c
!
K
[
c
!+1
K
[
(61)
Step 3: Obtaining crisp values. The output is given by
K
[
=
!=N
!=1
j
A
! (o
c
)c
!
K
[
!=N
!=1
j
A
! (o
c
)
. (62)
This FLC allows precise shaping of the gain function for B
2
6c in order to achieve better
tracking errors. Fig. 2 shows possible shapes of fuzzy gain functions K
[
B}c, chosen arbitrarily.
Note that the corresponding graph for the new non-fuzzy robust controller, as given by Eq. (56), is
a straight line from lower left corner (o
c
, K
[
o
c
) =(0, 0) to upper right corner (o
c
, K
[
o
c
) =(1, 1).
5.2. Fuzzy manifold robust controller
In the fuzzy manifold robust controller, the error manifold B=0 is implemented using fuzzy logic,
and Q
r
has the fuzzy component described for the fuzzy manifold boundary robust controller.
88 S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108
0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1
0
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
1
||B||/epsilon
K
f
*
|
|
B
|
|
/
e
p
s
i
l
o
n
Shape I
Shape II
Shape III
Shape IV
Shape V
Non-fuzzy
Fig. 2. Fuzzy gain functions: shapes IV and linear gain (non-fuzzy).
To choose the function [(e) for our controller, we assume that on the error manifold B= e +
[(e) =0 the system behaves as a set of n decoupled subsystems. We therefore choose a manifold
that minimizes a performance criteria for the a system of unit masses in the absence of friction:
e
i
= u
i
, |u
i
| 61. (63)
In terms of the state-space variables
e
i1
e
i
, e
i2
e
i
, x
i
= [e
i1
e
i2
]
T
, (64)
the equations of motion are
x
i1
= x
i2
, x
i2
= u
i
, |u
i
| 61. (65)
In particular, in order to minimize the time to reach the origin
e
i
= e
i
= 0, i = 1, . . . , n (66)
the solution is (see [32])
u
i
(x) =
_
_
sgn[o
i
(x
i
)] if o
i
(x
i
) = 0,
sgn[x
i2
] if o
i
(x
i
) = 0 and x
i
= 0,
0 if x
i
= 0,
(67)
S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108 89
where the switching surface (error manifold) o
i
(x) =0 is
o
i
(x
i
) =
_
x
i2
+
_
2x
i1
if x
i1
0,
x
i2
_
2|x
i1
| if x
i1
60.
(68)
Based on the discussion above, the error manifold chosen is
B = e + [(e), [(e) = diag[[
1
(e
1
) . . . [
n
(e
n
)]
T
,
[
i
(e
i
) = sign(e
i
)
_
2|e
i
|. (69)
Note that condition (28) is satised
[
i
(e
i
)
d[
i
de
i
=
1
2
_
|e
i
|
0. (70)
It can be seen that [
i
(e
i
) is discontinuous at e
i
=0. To overcome this problem we approximate [(e)
given in Eq. (69) by a continuously dierentiable fuzzy logic function. To improve performance
further, we use the fuzzy s
c
described previously for B6c (see Eq. (57)). The resulting controller,
denoted by fuzzy manifold robust controller, is described in the following.
Step 1: Choice of membership functions. Choose N fuzzy membership functions for each e
i
. Their
centers satisfy
e
!
i
e
!+1
i
, (71)
where ! =1, 2, . . . , N and i =1, 2.
Step 2: Formulation of fuzzy rules. Formulate the IFTHEN rules of the form
IF e
i
is A
!
e
i
THEN [ is B
!
[
i
. (72)
The centers of the THEN parts of the fuzzy sets B
!
[
i
, denoted by c
!
[
i
, satisfy
c
!
[
i
= sign(e
!
i
)
_
|e
!
i
|, (73)
where e
!
i
is the center of membership function A
!
e
i
.
Step 3: Obtaining crisp values. The output is given by
[
i
=
N
!=1
j
A
! (e
i
)c
!
[
i
N
!=1
j
A
! (e
i
)
(74)
which is continuously dierentiable if j
A
! (e
i
) is continuously dierentiable.
6. Simulation
Consider a two-link planar robotic arm shown in Fig. 3. The vector of generalized coordinates is
q =[x 0]
T
where x is the second joint displacement and 0 is the rst joint angle. The corresponding
generalized forces vector is Q=[F t]
T
.
90 S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108
Fig. 3. Two-degree-of-freedom system.
Assuming uniform rigid links, it can be shown that the equation of motion (1) for the RP arm is
given by
M(q) q +
C(q, q) q + q(q) = Q, (75)
M(q) =
_
m
1
0
0 m
1
x
2
+
4
3
m
2
L
2
c
_
, (76)
C(q, q) =
_
0 m
1
x
0
m
1
x
0 m
1
x x
_
, (77)
q(q) =
_
m
1
q cos(0)
(m
1
x + m
2
L
c
)q sin(0)
_
. (78)
The physical properties of the links used for the control systems are given in Table 1. It was assumed
that the rotational link is uniform and therefore L
c
=L}2.
The gain matrices were
=
_
10.0 0
0 10.0
_
, K
d
=
_
40.0 0
0 40.0
_
.
S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108 91
Table 1
Parameters of the RP robot arm
True Minimum Nominal Maximum
Mass of prismatic link (kg) 5.0 4.0 4.8 10.0
Mass of rotational link (kg) 2.0 1.0 2.9 3.0
Length of rotational link (m) 1.0 0.99 1.0 1.1
In all simulation cases, the system was required to follow a model system given by the dynamics
equation (1) with the following parameters:
M
m
(q) =
_
m
1
m
a
2
1
m
0
0 m
2
m
a
2
2
m
_
, C
m
(q, q) =
_
9.72
0
1
7.90
0
2
_
, q
m
(q) =
_
m
1
m
qa
1
m
0
1
m
2
m
qa
2
m
0
2
_
,
m
1
m
= 1.0, m
2
m
= 1.5, a
1
m
= 3.0, a
2
m
= 2.0, q = 9.81.
The models reference input, Q
m
, was
Q
1
m
= Q
2
m
=
_
t for t 68(s),
4(1.0 + cos[
2H
5
(t 8)]) for t 8(s)
(79)
with the initial conditions
q
m
0
= [0.35 0.0]
T
, q
m
0
= [0.0 0.0]
T
.
The initial conditions for the plant were assumed to be
q
0
= [0.5 0.0]
T
, q
0
= [0.0 0.0]
T
.
Resulting bounds on model rates and accelerations were
sup( q
m
2
) = 0.4483, sup( q
m
2
) = 0.3465. (80)
The output path, rates and accelerations of the model are shown in Fig. 4. In all the simulations,
the following design parameters were chosen (see Eqs. (21) and (24)):
c = 5.9 10
6
, p = 100. (81)
6.1. Robotic systems control laws
The following control laws were compared with the proposed control law via MATLAB simula-
tions. For detailed discussion of these methods, see [1, 17].
6.1.1. Inverse dynamics control law
For a mechanical system given by Eq. (1), the inverse dynamics control law is given by
Q = M(q)u
0
+ C(q, q) + q(q), (82)
u
0
= q
m
+ K
d
( q
m
q) + K
(q
m
q), (83)
92 S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108
] [
] [
rad
m x
d
d
] [
] [
sec
sec
rad
d
m
d
x
] [
] [
2
2
sec
sec
rad
d
m
d
x
D
e
s
i
r
e
d
P
a
t
h
D
e
s
i
r
e
d
R
a
t
e
s
D
e
s
i
r
e
d
A
c
c
e
l
e
r
a
t
i
o
n
s
.
.
..
..
(a)
(b)
(c)
Fig. 4. (a) Desired path, (b) desired rates, (c) desired accelerations.
where e =q q
m
. The gain matrices taken are diagonal positive-denite:
K
d
= diag(k
d
1
, k
d
2
), K
= diag(k
1
, k
2
) (84)
with k
1
=k
2
=400 and k
d
1
=k
d
2
=40. These are the same gains used for the proposed control law.
6.1.2. Robust saturation-type control law
The robust saturation-type control law is given by
Q = Q
N
+ Q
L
+ Q
p
. (85)
The inner non-linear control is given by
Q
N
=
C(q, q) + q(q), (86)
Q
p
=
M(q)t. (87)
S. Kohn-Rich, H. Flashner / Fuzzy Sets and Systems 133 (2003) 77108 93
Dene the following constants and functions:
:
r
=
z
M
z
m
z
m
+ z
M
, K = [K
K
d
], 1 = t
b
q
2
+ q
0
,
j(e, t) =
1
1 :
r
[:
r
Q
1
+K
i2
e
2
+ z
M
1(e, t)],
where z
M
and z
m
are the maximum and minimum eigenvalues of M(q), t
b
is dened in (3), q
0
is dened in (6), Q
1
is a nite number bigger than the supremum of the norm of the nominal
path accelerations vector, and the 2-induced matrix norm of K is dened by K
i2
=
_
z
max
(K
T
K).
Matrices K
and K
d
are dened by (84) and have the same values.
Then t is chosen to be
t =
_
_
j(e, t)
B
T
Pe
B
T
Pe
2
if B
T
Pe
2
c,
j(e, t)
B
T
Pe
c
if B
T
Pe
2
6c
(88)
where c0 is a small constant and P is a solution of Lyapunovs equation:
A
T
P + PA = Q, Q = 20. I (89)
with
A =
_
0 I
K
K
d
_
, B =
_
0
I
_
. (90)
The outer linear control is given by
Q
L
=
M(q)0, (91)
0 = q
d
K
d
( q q
m
) K
(q q
m
), (92)
where
M(q),
C(q, q) and q(q) denote the nominal values of the mass matrix, Coriolis terms and
potential terms, respectively.
6.1.3. Adaptive inertia-related control law
The adaptive control law is given by
Q =
M(q) v +