Beruflich Dokumente
Kultur Dokumente
0i
| q
i
|
g( q
i
)
q
i
Fi
( q
i
) =
0i
z
i
+
1i
dz
i
dt
+F
V i
q
i
(3)
z
i
is the unmeasurable internal state of the model,
which value is always bounded, see (de Wit et
al., 1995). q
i
is the velocity of the ith joint,
1i
is
a damping coecient,
0i
is a constant parameter
representing the stiness, the function g(q
i
) is a
positive continuous function which is meant to
describe the Striebeck eect (decreasing friction
force with increasing velocities in low velocity
regime). It can be dened as an exponential func-
tion of velocity: g( q
i
) = F
Ci
+(F
Si
F
Ci
)e
| qi|/ qiS
,
where F
Ci
represents the Coulombic friction co-
ecient, F
V i
is the viscous friction coecient,
F
Si
> F
Ci
the static friction term, q
Si
is the
Striebeck velocity in the ith joint.
Reformulated robot model for adaptive payload
compensation: Assume that the dimension of the
payload can be neglected related to the dimension
of the robot link. However, it does not mean that
the mass (m
PL
) and inertia of the payload do
not inuence the motion of the robot. Assume
that the payload has a sphere-like shape, hence
I
xxPL
= I
yyPL
= I
xxPL
= I
PL
. Rewrite the
model in the following form:
(H
R
(q) +m
PL
H
m
(q) +I
PL
H
I
(q))q + (4)
+(C
R
(q, q) +m
PL
C
m
(q, q)) q +
+D
R
(q) +m
PL
D
m
(q) =
F
( q)
The H
R
, C
R
, D
R
terms represents the of the
robotic arms without the payload. The H
m
, C
m
,
D
m
and H
I
terms contain the parts from the
robot model (1) which multiply the payload mass
and inertia respectively. It was exploited that the
product m
PL
I
PL
can never appear in the robot
model. With the parameters of the robotic arm
known and the joint variables q and q measured,
the H
m
, C
m
, D
m
, H
I
terms are considered known.
Friction model for adaptive compensation: To ap-
ply the well known adaptive control schemes for
friction compensation it is desirable that the fric-
tion force/torque in the ith joint of the robot
could be written in a linearly parameterized form,
namely as a scalar product between a known re-
gressor vector
Fi
( q
i
) and an unknown parameter
vector
Fi
(
Fi
=
T
Fi
Fi
( q
i
)). In the other hand
the friction parameters could change even in the
function of the sign of velocity. Hence it is rec-
ommended to use dierent friction parameters in
positive and negative velocity regimes. Moreover
the dynamics of the friction should also be taken
into consideration.
Denote the steady state value of the internal state
in (3) z
i
with z
ssi
. It can be expressed as: z
ssi
=
g( q
i
)sign( q
i
)/
0i
. From (3) yields:
Fi
=
0i
z
ssi
+
0i
(z
i
z
ssi
) +
1i
dz
i
dt
+F
V i
q
i
=g( q
i
)sign( q
i
) +F
V i
q
i
+
FDi
, where (5)
FDi
=
0i
(z
i
z
ssi
) +
_
1i
sign( q
i
) +
0i
1i
z
i
g( q
i
)
_
| q
i
|
In (5) the term g( q
i
)sign( q
i
) + F
V i
q
i
represents
the static part of the friction model and the rest of
the expression represents the dynamic behaviour
of the friction.
The dynamic part of the model is always bounded:
since z
i
, z
ssi
and g( q
i
) > 0 are bounded, from the
expression of
FDi
dened in (5) yields that there
exist two positive constants a
Di
, b
Di
satisfying:
|
FDi
| <
T
FDi
FDi
, (6)
where
FDi
= (a
Di
b
Di
)
T
;
FDi
= (1 | q
i
|)
T
The static part of the model has the form:
FSi
= g( q
i
)sign( q
i
) +F
V i
q
i
= (7)
(F
Ci
+ (F
Si
F
Ci
)e
| qi|/ qSi
)sign( q
i
) +F
V i
q
i
For the simplicity only the positive velocity do-
main is considered, but similar study can be made
for negative velocities. Consider that the ith joint
moves in 0 . . . q
maxi
velocity domain. The model
(7) is approximated using two lines: d
1i+
which
crosses through the (0,
Fi
(0)) point and it is tan-
gent to curve and d
2i+
which passes through the
( q
maxi
,
Fi
( q
maxi
)) point and tangential to curve.
These two lines meet each other at a q
swi+
veloc-
ity. (see Figure 1.) In the domain 0 . . . q
swi+
the
d
1i+
can be used for the linearization of the curve
and d
2i+
is used in the domain q
swi+
. . . q
maxi
.
The equations for d
1i+
and d
2i+
, using Taylor
expansion, are:
d
1i+
:
FSi1+
( q
i
) =F
Si
+
FSi
(0)
q
i
q
i
= (8)
=F
Si
+ (F
V i
(F
Si
F
Ci
)/ q
Si
) q
i
d
2i+
:
SFi2+
( q
i
) =
FSi
( q
maxi
) + (9)
+
FSi
( q
maxi
)
q
i
( q
i
q
maxi
)
Thus the linearization of the static friction model
in the 0 . . . q
maxi
velocity domain can be realized
using two lines:
FSi1+
( q
i
) = a
1i+
+b
1i+
q
i
, if 0 q
i
q
swi+
(10)
FSi2+
( q
i
) = a
2i+
+b
2i+
q
i
, if q
swi+
< q
i
q
maxi
Fig. 1. Linearization of the static part of the
friction
Using (8) and (9) can be shown that the switching
velocity is equal with the Striebeck velocity ( q
Si
).
Its value can be calculated as:
q
swi+
= q
Si
=
a
1i+
a
2i+
b
2i+
b
1i+
(11)
With same train of thoughts a similar model can
be determined for the negative velocity domain.
Combining the negative and positive velocity do-
mains the obtained static friction model can be
written as:
FSi
( q
i
) =
T
FSi
FSi
, where (12)
FSi
= ( a
1i+
b
1i+
a
2i+
b
2i+
a
1i
b
1i
a
2i
b
2i
)
T
FSi
= (
1i+
1i+
q
i
2i+
2i+
q
i
1i
1i
q
i
2i
2i
q
i
)
T
The switching functions
i
( q
swi
, q
i
) are intro-
duced to separate the velocity regimes in which
the dierent linearized friction models are applied.
For example
1i+
is dened as:
1i+
( q
swi+
, q
i
) =
_
1, if 0 q
i
q
swi+
0, otherwise
(13)
Hence, the friction in a joint of a robot can be
modeled as a sum of a static friction model and a
dynamic term (
Fi
=
FSi
( q
i
) +
FDi
( q
i
, z
i
)). The
static term can be written in piecewise linearly
parameterized form with discontinuous regressor
vector. The dynamic term is always bounded. Its
bound can also be written in piecewise linearly
parameterized form with discontinuous regressor
vector.
The robot model, based on which the adaptive
payload and friction compensation algorithm can
be formulated, reads as:
H
R
(q)q +C
R
(q, q) q +D
R
(q) + (14)
+m
PL
(H
m
(q)q +C
m
(q, q) q +D
m
(q)) +
+I
PL
H
I
(q)q +
FS
( q) +
FD
+d =
The equation above is formulated based on (4)
and using the presented friction modeling tech-
nique. The unknown frictional parameters, which
diers in dierent velocity regimes are in param-
eter vectors
FSi
and
FDi
, as it was presented in
(12) and (6) respectively. The value of the switch-
ing velocity (11) which separates dierent velocity
regimes in the friction model (12) and appears in
the regressor vector is not known, its a-priori guess
is necessary. It can introduce uncertainty at the
beginning of the adaptation. Hence, an additive
friction modeling error term (d with |d
i
| < D
FM
)
is introduced in the model.
3. THE CONTROL LAW
Control task: The problem is to design a control
input = (
1
2
. . .
n
)
T
such that the joint po-
sition q = (q
1
q
2
. . . q
n
)
T
track the desired tra-
jectory q
d
= (q
1d
q
2d
. . . q
nd
)
T
with given preci-
sion. The desired joint trajectories q
di
are known
bounded functions of time with bounded, known
rst and second order derivatives.
Dene the error metric S
i
that describes the
desired dynamics of the error system for the ith
joint: S
i
(t) = (
d
dt
+
i
)e
i
, e
i
= q
i
q
di
, where
i
is strictly positive constant. For the entire robot
the error metric can be dened as:
S = ( q q
d
) + (q q
d
) (15)
with > 0 diagonal matrix with positive ele-
ments.
Based on the error metric, the control problem
can be reformulated as: design a control input
such that |S
i
(t)| < if t , i = 1..n. > 0
is the given precision.
By using the original (1) and reformulated (14)
model, the dynamics of the error metric reads:
H
S = H(q q
d
+ ( q q
d
)) = H(q
d
+ ( q q
d
))
C(q, q) q D(q) +
F
( q) = CS +
+H
R
(q
d
+ ( q q
d
)) +C
R
( q
d
+ (q q
d
))
D
R
+m
PL
m
+I
PL
I
+
fS
fD
d (16)
where :
I
= H
I
(q
d
+ ( q q
d
))
m
= H
m
(q
d
+ ( q q
d
)) +
+C
m
( q
d
+ (q q
d
)) D
m
Control law: The payload and friction parameters
are unknown, only its estimated values can be
used in the control algorithm. Denote with m
PL
,
I
PL
the estimated payload parameters and with
FSi
and
FDi
the vectors of estimated static and
dynamic friction parameters in the ith joint.
In function of known robot arm parameters and
estimated friction and payload parameters the
control signal can be formulated as follows:
= H
R
(q
d
+ ( q q
d
)) (17)
C
R
( q
d
+ (q q
d
)) +D
R
K
S
S m
PL
I
PL
I
+
FS
+
FD
sat(S/) D
FM
sat(S/)
where
FSi
=
T
FSi
FSi
FDi
=
T
FDi
FDi
sat() denote the saturation function.
The last two terms in the control law are intro-
duced to compensate the eect of dynamic friction
behaviour and uncertainties of friction modeling
respectively. For the estimation of unknown pa-
rameters the following adaption laws are applied:
m
PL
=
m
S
T
I
PL
=
I
S
T
I
(18)
fSi
=
fSi
FSi
S
i
fDi
=
fDi
FDi
|S
i
|
with
m
,
I
> 0.
fSi
,
fDi
are diagonal matrices
with only positive elements on the diagonal.
Lyapunov analysis of the control: In order to
analyse the convergence of the tracking error
metric, dene the following Lyapunov function:
V (t) =
1
2
S
T
H(q)S +
1
m
2
m
2
PL
+
1
I
2
I
2
PL
+
+
1
2
n
i=1
T
FSi
1
FSi
FSi
+
1
2
n
i=1
T
FDi
1
FDi
FDi
(19)
in which the estimation errors are dened as
m
PL
= m
PL
m
PL
,
I
PL
= I
PL
I
PL
,
FSi
=
FSi
FSi
,
FDi
=
FDi
FDi
.
The time derivative of (19) can be calculated as:
V (t) = S
T
H(q)
S +
1
2
S
T
H(q)S (20)
m
PL
1
m
m
PL
I
PL
1
I
I
PL
i=1
T
FSi
1
FSi
FSi
i=1
T
FDi
1
FDi
FDi
By substituting the expression of the control law
(17) in the equation of error dynamics (16), yields:
H
S = CS + m
PL
m
+
I
PL
I
FS
+
+(
FD
FD
sat(S/)) K
S
S d D
FM
sat(S/)
where :
FSi
=
T
FSi
FSi
(21)
Outside the boundary layer (|S
i
| > i = 1..n)
we have: sat(S/) = sign(S)
Introduce the error dynamics (21) and the adapta-
tion laws (18) into (20) and applying the property
(2) of the robot model, the time derivative of the
Lypaunov function reads as:
V (t) = S
T
K
S
S
n
i=1
_
FDi
S
i
+
T
FDi
FDi
|S
i
|
_
i=1
_
T
FDi
FDi
|S
i
|
_
S
T
d |S|
T
D
FM
(22)
Applying that d
i
S
i
< D
FM
|S
i
|, if |d
i
| < D
FM
,
yields:
V (t) < S
T
K
S
S
n
i=1
_
FDi
S
i
T
FDi
FDi
|S
i
|
_
(23)
According to (6) the second term in (23) is always
negative. It yields:
V (t) < S
T
K
S
S (24)
Outside the boundary layer S
T
K
S
S > 0, hence
n
i=1
|q
i
q
di
|))
was calculated during the rst T = 2.2 sec-
onds of the simulation with the PID controller,
model based and the adaptive friction and pay-
load compensator controller. The following values
has been obtained: E
A
(PID) = 13E 4 [mm],
E
A
(MODEL BASED) = 9.65E 4 [mm],
E
A
(ADAPTIV E) = 5.34E 4 [mm].
5. CONCLUSIONS
To deal with payload and friction induced un-
certainties in robotic systems, an adaptive con-
trol algorithm was introduced for high precision
position tracking tasks. In order to develop the
control algorithm, in the robot model the eect
of the payload was separated from the robot arm
dynamics. To describe the friction force in the
robot joints a piecewise linearly parameterized
friction model was introduced. Using Lyapunov
analysis it was shown that the control algorithm
guarantees the convergence of the tracking error
inside a predened boundary layer. Simulation
results show that the introduced adaptive control
algorithm assures high precision tracking of time
varying trajectories.
REFERENCES
Bona, Basilio and Marina Indri (2005). Friction
compensation in robotics: an overview. In:
Proceedings of the 44th IEEE Conference on
Decision and Control, and the European Con-
trol Conference. Seville, Spain.
de Wit, C. Caundas, H. Ollson, K. J.
Astrom
and P. Lischinsky (1995). A new model for
control of systems with friction. IEEE Trans.
on Automatic Control 40(3), 419425.
J.Wang, S. S. Ge and T. H. Lee (2001). Adap-
tive NN control of robot manipulator with
unknown dynamic friction. In: Proc. of Asian
Conference on Robotics and Applications.
Singapore.
Kim, Young, Frank Lewis and Darren Dawson
(2000). Intelligent optimal control of robotic
0 0.5 1 1.5 2
1
0.5
0
0.5
J
o
i
n
t
1
P
o
s
i
t
i
o
n
e
r
r
o
r
[
m
m
]PID control (Kp=30)
0 0.5 1 1.5 2
0.5
0
0.5
J
o
i
n
t
2
P
o
s
i
t
i
o
n
e
r
r
o
r
[
m
m
]
0 0.5 1 1.5 2
1
0.5
0
0.5
J
o
i
n
t
1
P
o
s
i
t
i
o
n
e
r
r
o
r
[
m
m
]
Model based control (K
S
= 30)
0 0.5 1 1.5 2
0.5
0
0.5
J
o
i
n
t
2
P
o
s
i
t
i
o
n
e
r
r
o
r
[
m
m
]
0 0.5 1 1.5 2
1
0.5
0
0.5
J
o
i
n
t
1
P
o
s
i
t
i
o
n
e
r
r
o
r
[
m
m
]
Adaptive control (K
S
= 30)
0 0.5 1 1.5 2
0.5
0
0.5
Time [sec]
J
o
i
n
t
2
P
o
s
i
t
i
o
n
e
r
r
o
r
[
m
m
]
0 0.5 1 1.5 2
1
0
1
2
E
s
t
i
m
a
t
e
d
p
a
y
l
o
a
d
m
a
s
s
[
k
g
]
Estimated parameters
0 0.5 1 1.5 2
0
0.1
E
s
t
i
m
a
t
e
d
p
a
y
l
o
a
d
i
n
e
r
t
i
a
[
k
g
m
2
]
0 0.5 1 1.5 2
0
0.5
1
J
o
i
n
t
1
a
1
+
[
N
m
]
0 0.5 1 1.5 2
1
0.5
0
J
o
i
n
t
1
b
1
+
[
N
m
s
e
c
/
r
a
d
]
0 0.5 1 1.5 2
0
0.2
0.4
J
o
i
n
t
1
a
2
+
[
N
m
]
0 0.5 1 1.5 2
0
0.5
1
Time [sec]
J
o
i
n
t
1
b
2
+
[
N
m
s
e
c
/
r
a
d
]
Fig. 2. Simulation results
mainpulators using neural fnetworks. Auto-
matica 36, 13551364.
Leahy, M., M. Johnson and S. Rogers (1991). Neu-
ral network payload estimation for adaptive
robot control. IEEE Trans. On Neural Net-
works 2(1), 93100.
Lewis, Frank L., Darren M. Dawson and
Chaouki T. Abdallah (2004). Robot Manipu-
lator Control. Marcel Dekker, Inc.. New York.
M arton, L orinc (2006). Robust-Adaptive Con-
trol of Nonlinear Singlevariable Mechatronic
Systems and Robots. PhD thesis. Budapest
University of Technology and Economics.
www.ms.sapientia.ro/ martonl.
Panteley, E., R. Ortega and M. Gafvert (1998).
An adaptive friction compensator for global
tracking in robotic manipulator. Systems and
Control Letters 33, 307313.
Putra, D., H. Nijmeijer, N. van deWouw, O.C.L.
Haas and K.J. Burnham (2006). Analysis
of friction compensation eects in controlled
mechanical systems. In: Proceedings of the In-
ternational Conference on Systems Engineer-
ing. Coventry, England.
Slotine, Jean-Jaques and Weiping
Li (1988). Adaptive manipulator control: A
case study. IEEE Trans. on Automatic Con-
trol 33(11), 9951003.
Tomei, Patrizio (2000). Robust adaptive friction
compensation for tracking control of robot
manipulators. IEEE Trans. on Automatic
Control 45(6), 21642169.
Xu, Haojian and Petros A. Ioannou (2003). Ro-
bust adaptive control for a class of MIMO
nonlinear systems with guaranteed error
bounds. IEEE Trans. on Automatic Control
48(5), 728743.