Professional Documents
Culture Documents
r
2b
bC
0
2dS
0
r
2b
bS
0
2dC
0
r
2b
bS
0
dC
0
2
4
3
5
_
u
R
_
u
L
" #
: 2
where
_
u
R
and
_
u
L
, are the angular velocities of the right and the left wheels, respectively,
C
0
cosw and S
0
sinw. Displaying the rotation matrix explicitly, we can write
equation (2) as:
_ x
F
_ y
F
" #
C
0
2S
0
S
0
C
0
" #
r
2
r
2
2dr
2b
dr
2b
2
4
3
5
_
u
R
_
u
L
" #
: 3
The linear velocity of the end-effector is found using the fact that its base velocity is
known and given by equation (3). Therefore, the end-effector velocity is written as:
Figure 1.
Mobile manipulator
system on a
differentially-driven
platform
q
L
q
R
j
q
1
q
2
L
1
(m
2
, I
2
)
(m
1
, I
1
)
(m
w
, I
w
)
(m
c
, I
c
)
L
2
E
F
b
b
y
x O
r
d
O
Adaptive
tracking control
83
_ x
E
_ y
E
" #
_ x
F
_ y
F
" #
C
0
2S
0
S
0
C
0
" #
J
11
J
12
J
21
J
22
" #
_
u
1
_ w
_
u
2
" #
: 4
where J
ii
i; j 1; 2 terms are the elements of the xed-base Jacobian of the
manipulator employed, given by:
J
11
2L
1
S
1
2L
2
S
12
; J
12
2L
2
S
12
; J
21
L
1
C
1
L
2
C
12
; J
22
L
2
C
12
where L
1
, L
2
are the lengths of the rst, and the second arm, respectively, and u
1
, u
2
, are
the joint variables of the manipulator. With the notation: C
i
cosu
i
, S
i
sinu
i
,
C
ij
cosu
i
u
j
and S
ij
sinu
i
u
j
, ;i; j 1; 2.
Combining equations (3) and (4), the forward differential kinematics of the mobile
manipulator is obtained as:
_ x
E
_ y
E
_ x
F
_ y
F
2
6
6
6
6
6
4
3
7
7
7
7
7
5
C
0
2S
0
0 0
S
0
C
0
0 0
0 0 C
0
2S
0
0 0 S
0
C
0
2
6
6
6
6
6
4
3
7
7
7
7
7
5
r
2
2
r
2b
J
11
r
2
r
2b
J
11
J
11
J
12
2
r
2b
d J
21
r
2b
d J
21
J
21
J
22
r
2
r
2
0 0
2
dr
2b
dr
2b
0 0
2
6
6
6
6
6
6
6
6
6
6
6
4
3
7
7
7
7
7
7
7
7
7
7
7
5
_
u
R
_
u
L
_
u
1
_
u
2
2
6
6
6
6
6
4
3
7
7
7
7
7
5
: 5
which can be expressed in the following form:
_ x RJ _ z J
z
_ z: 6
And its time derivative as:
x
_
J
z
_ z J
z
z: 7
2.2. Dynamic modeling
The dynamics of a mobile manipulator subject to non-holomonic constraints can be
obtained using the Lagrangian approach in the following form:
Hq q Vq; _ q A
T
ql Eqt: 8
where q q
1
. . .q
n
T
[ R
n1
is the generalized coordinates, Hq [ R
nn
is a
symmetric, positive denite inertia matrix, Vq; _ q [ R
nn
represents the vector of
centripetal and Coriolis forces terms, Aq [ R
mn
is the constraint matrix, l [ R
m1
is the Lagrange multiplier which denotes the vector of constraint forces, Eq [
IJICC
4,1
84
R
nn2m
is the input transformation matrix and t [ R
n2m1
is the vector of input
torques.
It is possible to dene (n 2 m) independent velocities _ z
_
u
R
;
_
u
L
;
_
u
1
;
_
u
2
T
such that:
_ q Sq_ z: 9
where the matrix S(q) is dened as:
Sq
r
2b
bC
0
dS
0
r
2b
bC
0
2dS
0
0 0
r
2b
bS
0
2dC
0
r
2b
bS
0
dC
0
0 0
r
2b
2
r
2b
0 0
0 0 1 0
0 0 0 1
2
6
6
6
6
6
6
6
4
3
7
7
7
7
7
7
7
5
10
Substituting equation (9) and its derivative into equation (8), and left multiplying S
T
,
we obtain:
H
z
q z V
z
q; _ q_ z G
z
t
z
: 11
where H
z
S
T
HS, V
z
S
T
H
_
S; G
z
S
T
V and t
z
S
T
Et.
J
z
is a full rank square matrix, from equations (6) and (7) we get:
_ z J
21
z
_ x: 12
And:
z J
21
z
x 2J
21
z
_
J
z
J
21
z
_ x: 13
Substituting equations (12) and (13) into equation (11) and left multiplying J
21
z
,
we obtain the dynamic of the system in the task space as:
H
x
q x V
x
q; _ q_ x G
x
t
x
: 14
where H
x
J
2T
z
H
z
J
21
z
; V
x
J
2T
z
V
z
2H
z
J
21
z
_
J
z
J
21
z
; G
x
J
2T
z
G
z
and t
x
J
2T
z
t
z
.
The dynamic system equation (14), possess a number of important properties that
facilitate analysis and control system design. Among these are:
.
Property 1. The inertia matrix H
x
(q) is symmetric and positive denite,
i.e. H
T
x
H
x
s 0.
.
Property 2.
_
H
x
22V
x
is skewsymmetric, i.e. hence x
T
H
x
22V
x
x 0; ;x [ R
n
.
Property 3. H
x
, V
x
and G
x
are all bounded as long as J
z
is non-singular.
.
Property 4. System equation (14) is linearly parametertrizable (LP), i.e.
H
x
q _ n V
x
q; _ qn G
x
q Yq; _ q; n; _ nu where Y is called the
n p dynamic regressor matrix, which contains known function
and u is a constant vector of unknown parameters.
Adaptive
tracking control
85
3. Adaptive controller design
Suppose that the desired trajectories in task space are described by x
d
and _ x
d
. In order to
track the desired trajectories, we have to design a passivity based controller given by
Spong (2005):
t
x
H
x
_ n V
x
n G
x
2Kr: 15
where n and r are given as:
e x 2x
d
v _ x
d
2Le
r _ x 2v
: 16
With L and K are a diagonal matrices of positive gains.
Substituting equations (15) and (16) into equation (14) yields:
H
x
_ r V
x
r Kr 0: 17
The closed loop system equation (17) is non-linear and coupled. Consider the Lyapunov
function:
V
1
2
r
T
H
x
r e
T
LKe: 18
The time derivative of V can be computed as:
_
V 2_ e
T
K_ e 2e
T
LKLe # 0: 19
It is obvious that errors will asymptotically converge to zero if the dynamics of the
system are known exactly. On the other hand, the existence of disturbances and
uncertainties inuences the performance of the passivity based controller and make the
closed loop systemunstable. To handle imperfect knowledge of the mobile manipulator
parameters and external disturbances, the passivity based controller equation (15) is
modied as:
t
x
^
H
x
_ v
^
V
x
v
^
G
x
2Kr: 20
where
^
H
x
,
^
V
x
and
^
G
x
are estimate of unknown parameters
^
H,
^
V and
^
G.
According to property equation (4), we can rewrite equation (20) as:
t
x
Yq; _ q; v; _ v
^
u 2Kr: 21
Where
^
u is estimates of unknown constant parametric vector u. Substituting equation
(21) into (14), we may have the closed-loop error dynamics:
H
x
_ r V
x
r Kr Yq; _ q; v; _ v
~
u: 22
Where
~
u
^
u 2u. If an appropriate adaptive update law for
^
u can be selected, we may
easily to prove the convergence of the tracking errors to zero and the system stability.
IJICC
4,1
86
Let us dene a Lyapunov function candidate as:
V
1
2
r
T
H
x
r e
T
L
T
Ke
1
2
~
u
T
G
~
u: 23
Where G is a positive constant design matrix. The time derivative of V can be
computed as:
_
V r
T
H
x
_ r
1
2
_
H
x
r 2e
T
L
T
Ke
_
~
u
T
G
~
u: 24
Substituting the closed-loop error dynamics equation (22) in the above equation, we get:
_
V r
T
Yq; _ q; v; _ v
~
u 2Kr 2r
_
H
x
22V
x
2e
T
L
T
Ke
_
~
u
T
G
~
u: 25
Since
_
H
x
22V
x
is a skrew symmetric, the above equation become:
_
V 2_ e
T
K_ e 2e
T
L
T
KLe
~
ur
T
Yq; _ q; v; _ v
_
~
u
T
G: 26
With selected update law as:
_
^
u 2G
2T
Y
T
q; _ q; v; _ v r: 27
The time derivative of the Lyapunov function is negative
_
V # 0 and the system is
asymptotically stable.
The proposed adaptive control system is shown in Figure 2.
4. Simulation results
To verify the effectiveness of the proposed adaptive robust control, let us consider the
mobile manipulator system shown in Figure 1. Simulation parameters are shown in
Table I.
Figure 2.
Structure of the
proposed controller
Forward
kinematics
Forward
kinematics
Mobile
manipulator
Adaptive
tracking control
87
The initial conditions are given as follow:
q0
0; 0;
p
2
; 0; 0;
p
4
; 2
p
2
h i
T
and _ z0
0; 0; 0; 0
h i
T
Let the desired trajectory be:
x
d
t
x
d
E
; y
d
E
; x
d
F
; y
d
F
h i
T