In this work, well-known Lagrange formula was employed in order to derive both the kinematics
and dynamics of the nonholonomic WMR in the presence of the unknown wheel slips. Then, the
adaptive tracking controller based on the RBFNN with the online weight tuning algorithm has been
developed to allow the WMR to track the desired trajectory with the desired tracking performance.
The RBFNN functional approximation errors and the effect of the unknown wheel slips have been
dealt with in the same way as the model uncertainties as well as the unknown external disturbances,
since they all have the same influence on the closed-loop system. A priori offline train for the weights
of the RBFNN was not needed since they can be initialized without difficulty. It has been shown that
the convergence of the position tracking errors to an arbitrarily small neighborhood of the origin is
guaranteed by the standard Lyapunov theory and LaSalle extension. The results of Matlab/Simulink
simulation confirmed the effectiveness and advantage of the proposed controller.
16 trang |
Chia sẻ: huongthu9 | Lượt xem: 432 | Lượt tải: 0
Bạn đang xem nội dung tài liệu Neural network-Based adaptive tracking control for a nonholonomic wheeled mobile robot subject to unknown wheel slips, để tải tài liệu về máy bạn click vào nút DOWNLOAD ở trên
Journal of Computer Science and Cybernetics, V.33, N.1 (2017), 70–85
DOI 10.15625/1813-9663/33/1/8914
NEURAL NETWORK-BASED ADAPTIVE TRACKING CONTROL
FOR A NONHOLONOMIC WHEELED MOBILE ROBOT
SUBJECT TO UNKNOWN WHEEL SLIPS
TINH NGUYEN1, HUNG LINH LE2
1Institute of Information Technology, Viet Nam Academy of Science and Technology
2University of Information and Communication Technology, Thai Nguyen University
1nvtinh@ioit.ac.vn; 2lhlinh@ictu.edu.vn
Abstract. In this paper, Lagrange formula is employed with the purpose of modelling both the
kinematics and dynamics of a nonholonomic wheeled mobile robot (WMR) subject to unknown
wheel slips, model uncertainties such as unstructured unmodelled dynamic components, and unknown
external disturbances such as unknown external forces. Afterwards, an adaptive tracking controller
based on a radial basis function neural network (RBFNN) with an online weight tuning algorithm
is proposed for tracking a predefined trajectory. Prior neural network offline training is not needed
for the weights since they are easily initialized. Thanks to this proposed control approach, a desired
tracking performance is obtained in which position tracking errors uniformly ultimately converge to
an arbitrarily small neighborhood of the origin. In the sense of Lyapunov and LaSalle extension, the
stability of the whole closed-loop system is guaranteed to achieve this desired tracking performance.
The comparative results of computer simulation have validated the rightness and efficiency of the
proposed controller.
Keywords. Online weight tuning algorithm, wheeled mobile robot, uniformly ultimately bounded,
unknown wheel slip.
1. INTRODUCTION
It is well known that wheeled mobile robots (WMR) have ability to work in a wide area, and
furthermore they are capable of performing tasks intelligently without any human action. Besides,
they can replace people on dangerous tasks such as looking for explosive materials, transporting
of goods in poisonous environments, rescue, etc. Therefore, they have been applied widely and
increasingly popular in various areas such as industry, entertainment, health care, automation in
logistics, transport, etc.
In recent years, many researchers in the world have paid their attention to research motion control
problems for WMRs. In [3, 4, 5, 7, 8], the controllers were designed to take account of kinematic and
dynamic model of WMR without slipping motions.
Nonetheless, unfortunately, the condition “pure rolling without slip” has been not always satisfied
in practice. To put it simply, there has been the existence of wheel slip. The wheel slip depends on a
number of various factors namely an unknown centrifugal force acting on a WMR when it moves in
a circular path, an external force acting on a WMR when it collides with another unknown object,
a weak frictional force between the slippery floor and the wheels, etc. Consequently, if one wants
c© 2017 Vietnam Academy of Science & Technology
NEURAL NETWORK-BASED ADAPTIVE TRACKING CONTROL 71
a motion control problem to be effectively addressed in such context, then during designing motion
controllers for WMR, the wheel slip must be considered. With the aim of compensating for the
harmful effect of the wheel slip, an adaptive tracking controller has been developed via slip-ratios
[9]. The approaches based on gyros and accelerometers to cope with the wheel slip have been also
illustrated in [2, 13]. The authors in [15] have illustrated the models of WMRs taking account of
both wheel longitudinal and lateral slippage and then analyzed their controllability according to their
maneuverability. Approaches for designing controllers have also been investigated in [10, 11] for the
path following and tracking of WMRs in the presence of longitudinal and lateral slippage. In [17], S.
J. Yoo has designed a neural-network-based adaptive control method for tracking path and avoiding
obstacle for a class of WMRs in the presence of unknown skidding, slipping, and torque saturation.
The work in [12] has addressed the slippage phenomenon for exactly kinematic modeling and then
controlling for a WMR. In [6], the slip ratios of all wheels could be estimated via an experimental
study. The authors in [14] have proposed a feedback linearization controller for a WMR tracking
a desired trajectory with longitudinal and lateral slip under an ideal condition where there did not
exist both model uncertainties and unknown external disturbances, and further the accelerations and
velocities of the wheel slips were measured exactly. However, it is impossible to achieve a desired
tracking performance in real applications because the ideal condition is not realistic.
To sum up, most of these aforementioned works except for [1, 16] have been based on an assump-
tion that the measurements of the wheel slips were ready so as to analyze and design slip-compensation
controllers. The drawback of this assumption is the extra demand of expensive and complex sensors
to measure the wheel slip namely global position system (GPS), gyroscope, accelerometer, etc.
These results have motivated us to propose a novel neural network-based adaptive controller for a
WMR with the both longitudinal and lateral wheel slip in such a way that the WMR tracks a desired
trajectory with a desired tracking performance. Moreover, those measurements of wheel slip are no
longer necessary.
The main purpose of this paper is that a neural network (NN) adaptive tracking controller is
proposed for a WMR in the presence of unknown wheel slip, model uncertainties, and unknown
external disturbances to track a predefined trajectory. Firstly, to do this, the Lagrange dynamic
approach has been used to derive both the kinematics and the dynamics of the WMR in this situation.
Secondly, with purpose of overcoming the harmful effect of unknown wheel slip, model uncertainties,
and unknown external disturbances, a RBFNN adaptive tracking controller has been proposed. In
this controller, the RBFNN with online weight tuning algorithm is employed to approximate unknown
nonlinear smooth functions due to no prior knowledge of the dynamic model of this WMR. Finally,
a Matlab/Simulink simulation was implemented to certify the effectiveness and the performance of
the proposed controller.
The remainder of this article is structured as follows. Section 2 represents the progress by which
both the kinematics and the dynamics of a WMR are modeled in the presence of both lateral and
longitudinal slip between the driving wheels and the floor. In section 3, a RBFNN adaptive tracking
controller with an online weight tuning algorithm is proposed, and the uniformly ultimately bounded
stability of the closed-loop system to an adjustable neighborhood of the origin is proven in Lyapunov
theory and LaSalle extension. Next, a computer simulation is shown in section 4 to certify the
effectiveness and the performance of the proposed controller. Finally, section 5 illustrates our research
conclusions.
72 TINH NGUYEN, HUNG LINH LE
2. THE KINEMATICS AND DYNAMICS OF A NONHOLONOMIC WMR
WITH UNKNOWN WHEEL SLIP
2.1. The kinematic model
Let us consider a nonholonomic WMR which comprises two driving wheels and a caster wheel as
Figure 1. To be specific, G is the center of mass of the platform of the WMR. M is the midpoint
of the wheel shaft. F1 and F2 are the total longitudinal friction forces at the right and left wheel,
respectively. F3 is the total lateral friction force along the wheel shaft. F4 and $ are external force
and moment acting on G, respectively. r is the radius of each wheel. b is the haft of the wheel shaft.
a is the distance between M and G.
Let xM , yM denote the coordinates of M . Likewise, let xG, yG denote those of G. θ is the
orientation of the WMR. When there does not exist wheel slip between the wheels and the floor, the
linear and angular velocities of the WMR, computed at M, are represented respectively as follows [8]
Θ =
r
(
Φ˙R + Φ˙L
)
2
, µ =
r
(
Φ˙R − Φ˙L
)
2b
, (1)
where Φ˙R, Φ˙L are the angular velocities of the right and left driving wheel about the wheel shaft,
respectively.
Hence, the kinematics of the WMR is written as follows [7]
x˙M = Θ cos θ,
y˙M = Θ sin θ,
θ˙ = µ.
(2)
On the other hand, when the WMR moves in the presence of slip between the wheels and the
floor, (1) - (2) are no longer true. Now, let γR and γL denote the coordinates of the longitudinal slip
of the right and left driving wheel, respectively (see Figure 1). Similarly, η denotes the coordinate of
the lateral slip along the wheel shaft. In this case, the actual linear velocity of the WMR along the
longitudinal direction is shown as follows [14]
Ω =
r
(
Φ˙R + Φ˙L
)
2
+
γ˙R + γ˙L
2
= Θ +
γ˙R + γ˙L
2
. (3)
The actual angular velocity of the WMR is computed as follows [14]
ω =
r
(
Φ˙R − Φ˙L
)
2b
+
γ˙R − γ˙L
2b
= µ+ ϑ, with ϑ =
γ˙R − γ˙L
2b
. (4)
Thus, the kinematic model of this WMR can be written in terms of the coordinates of M as
follows [14]
x˙M = Ω cos θ − η˙ sin θ,
y˙M = Ω sin θ + η˙ cos θ,
θ˙ = ω.
(5)
Due to the wheel slip, the perturbed nonholonomic constrain equations can be written as follows
[16]
NEURAL NETWORK-BASED ADAPTIVE TRACKING CONTROL 73
γ˙R = −rΦ˙R + x˙M cos θ + y˙M sin θ + bω, (6)
γ˙L = −rΦ˙L + x˙M cos θ + y˙M sin θ − bω, (7)
η˙ = −x˙M sin θ + y˙M cos θ (8)
cos sin sinq h q w qG =Wx a
sin cos cosq h q w qy aG =W
G G
1 1)
1
D
2 2 2)21 1r IR W R
1
D
2 2 2)21 1r IL W L
]
=
- +ç ÷¶ ¶è ø
F2
F
1
F
3
h
Left
driving
wheel
Right driving
wheel
caster wheel
G
M a
2b
F
4
v
yM
y
G
x
M
x
G
q
2r
g
L
g
R
wheel shaft
X
Y
O
Figure 1. The nonholonomic WMR subjected to the wheel slip
2.2. Dynamic model of the WMR with wheel slip
The derivatives with respect to time of the coordinates of the mass center, G, are computed as
follows
x˙G = Ω cos θ − η˙ sin θ − aω sin θ, (9)
y˙G = Ω sin θ + η˙ cos θ + aω cos θ. (10)
Let mG be the mass of the platform of the WMR without the driving wheels. IG is the moment
of inertia of this platform about the vertical axis through G. The kinetic energy of this platform is
computed as follows [8]
KG =
1
2
mG
(
x˙2G + y˙
2
G
)
+
1
2
IGω
2. (11)
The kinetic energies of the right and left driving wheel are computed, respectively, as follows [8]
KR =
1
2
mW
[(
rΦ˙R + γ˙R
)2
+ η˙2
]
+
1
2
IW Φ˙
2
R +
1
2
IDω
2, (12)
KL =
1
2
mW
[(
rΦ˙L + γ˙L
)2
+ η˙2
]
+
1
2
IW Φ˙
2
L +
1
2
IDω
2, (13)
74 TINH NGUYEN, HUNG LINH LE
where IW or ID respectively is the inertial moment of each driving wheel about its rotational and
diameter (vertical) axis.
The total kinetic energy of the whole system is
K = KG +KL +KR. (14)
Let q = [xG, yG, θ, η, γR, γL,ΦR,ΦL]
T
be the Lagrange coordinate vector, the perturbed non-
holonomic constraint equations (6), (7), and (8) can be rewritten as follows
A (q) q˙ = 0 where A (q) =
cos θ sin θ b 0 −1 0 −r 0cos θ sin θ −b 0 0 −1 0 −r
− sin θ cos θ a −1 0 0 0 0
(15)
The potential energy of the whole system always equals to zero, so its Lagrange function is
L = K. The Lagrange equation can be written in the following form [7]
d
dt
(
∂L
∂q˙
)
− ∂L
∂q
+ τ¯ d = Nτ + A
Tλ (16)
where λ = [λ1, λ2, λ3]
T
is the vector of Lagrange multipliers which are considered as constraint forces
acting on the WMR so that its motion satisfies the nonholonomic constraint (15). τ = [τR, τL]
T
is the input vector with τR and τL being the torques at the right and left driving wheel about the
wheel shaft, respectively. τ¯ d is a vector illustrating both model uncertainties such as unstructured
unmodelled dynamics and unknown bounded disturbances namely unknown external forces as F1,
F2, F3, F4, $ (see Figure 1). N is the input transformation matrix. Solving this Lagrange equation,
the dynamic equation of the whole system can be represented by
M¯q¨ + τ¯ d = Nτ + A (q)
T λ, (17)
where
M¯ =
mG 0 0 0 0 0 0 0
0 mG 0 0 0 0 0 0
0 0 IG + 2ID 0 0 0 0 0
0 0 0 2mW 0 0 0 0
0 0 0 0 mW 0 mW r 0
0 0 0 0 0 mW 0 mW r
0 0 0 0 mW r 0 mW r
2 + IW 0
0 0 0 0 0 mW r 0 mW r
2 + IW
,
N =
0 0
0 0
0 0
0 0
0 0
0 0
1 0
0 1
.
NEURAL NETWORK-BASED ADAPTIVE TRACKING CONTROL 75
Alternatively, it is easy to achieve the following equation [14]
q˙ = S1 (q) v + S2 (q) γ˙ + S3 (q) η˙, (18)
where v =
[
Φ˙R, Φ˙L
]T
, γ = [γR, γL]
T
, S1 (q) ,S2 (q) ,S3 (q) are expressed by
S1 =
(r
2
cos θ − ar
2b
sin θ
) (r
2
cos θ +
ar
2b
sin θ
)(r
2
sin θ +
ar
2b
cos θ
) (r
2
sin θ − ar
2b
cos θ
)
r
2b
− r
2b
0 0
0 0
0 0
1 0
0 1
,
S2 =
(
1
2
cos θ − a
2b
sin θ
) (
1
2
cos θ +
a
2b
sin θ
)
(
1
2
sin θ +
a
2b
cos θ
) (
1
2
sin θ − a
2b
cos θ
)
1
2b
− 1
2b
0 0
1 0
0 1
0 0
0 0
S3 =
[ − sin θ cos θ 0 1 0 0 0 0 ]T
.
Next, taking the time derivative of (18), we obtain
q¨ = S˙1 (q) v + S1 (q) v˙ + S2 (q) γ¨ + S˙2 (q) γ˙ + S˙3 (q) η˙ + S3 (q) η¨, (19)
ST1 (q) A
T (q) = 02×3, ST1 (q) S¨1 (q) = 02×2, S
T
1 (q) N = I2×2, where Ii×j is an unit
i× j matrix, and 0i×j is a zero i× j matrix.
Substituting (19) into (17), and then pre-multiplying the both sides of the new equation by
ST1 (q), we get
Mv˙ + Bv + B¯v + Qγ¨ + Cωη˙ + Gη¨ + τ d = τ , (20)
where τ¯ d = S1 (q) τ¯ d,
M = ST1 M¯S1 =
[
m11 m12
m12 m11
]
, Q = ST1 M¯S2 =
[
Q11 Q12
Q12 Q11
]
,Cω = ST1 MS˙3 = mG
r
2
[
1
1
]
ω,
m11 = mG
(
r2
4
+
a2r2
4b2
)
+
r2
4b2
(IG + 2ID) +mW r
2 + IW ,
76 TINH NGUYEN, HUNG LINH LE
m12 = mG
(
r2
4
− a
2r2
4b2
)
− r
2
4b2
(IG + 2ID) ,
Q11 = mG
r
4
(
1 +
a2
b2
)
+
r
4b
(IG + 2ID) , Q12 = mG
r
4
(
1− a
2
b2
)
− r
4b
(IG + 2ID) ,
G = ST1 MS3 = mG
ar
2b
[
1
−1
]
, B = ST1 MS˙1 = mG
ar2
2b
µ
[
0 1
−1 0
]
,
and B¯ = ST1 MS˙1 = mG
ar2
2b
ϑ
[
0 1
−1 0
]
, with µ =
Φ˙R − Φ˙L
2
, ϑ =
γ˙R − γ˙L
2
.
3. CONTROL DESIGNING
3.1. Problem Statement
Let D(xD, yD) be a target which is moving in a known desired trajectory (see Figure 2). Without
loss of generality, the motion equation of D can be supposed as follows{
xD = TD.t−R cos(υ.t) + x0
yD = βTD.t+R sin(υ.t) + y0,
(21)
where β, TD, R, υ, x0, y0 are constant parameters, and time t varies from zero to infinity.
We assume that the tool location is at point P. So, the requirement of the position tracking
control problem is to control the WMR so that P has to track D with the position tracking errors
being uniformly ultimately bounded.
Remark 1. In Figure 2, we denote (xP , yP ) as the position of P . Let (xP , yP , θ) be the
actual posture of the WMR, and (xPd, yPd, θd) be the desired one of the WMR. The presence of
both the longitudinal and lateral slips makes it impossible to control the WMR in the way that the
actual posture (xP , yP , θ) tracks the desired one (xPd, yPd, θd) with an arbitrarily good tracking
performance. Instead of this, it is fully possible to control the WMR with the purpose of making
the actual position (xP , yP ) track the desired one (xPd, yPd) with an arbitrarily good tracking
performance.
3.2. Describing the vector of position tracking errors and the the vector of
filtered tracking errors
Let O-XY be the global coordinate system, M-XY be the body coordinate system which is
attached to the platform of the WMR (see Figure 2). The coordinate of the target is represented in
M-XY as follows [14]
ζ =
[
ζ1
ζ2
]
=
[
cos θ sin θ
− sin θ cos θ
] [
xD − xM
yD − yM
]
. (22)
Taking the second order derivative with respect to time of (22) yields [14]
ζ¨ = −hv˙ + Ψ1 + Ψ2, (23)
NEURAL NETWORK-BASED ADAPTIVE TRACKING CONTROL 77
where h =
(
ζ2
1
b
− 1
)
r
2
−
(
ζ2
1
b
+ 1
)
r
2
−ζ1 r
2b
ζ1
r
2b
, and Ψ1, Ψ2 are nonlinear components revealed
as follows
Ψ1 = h˙v +
[
x¨D cos θ + y¨D sin θ − x˙Dµ sin θ + y˙Dµ cos θ
−x¨D sin θ + y¨D cos θ − x˙Dµ cos θ − y˙Dµ sin θ
]
,
Ψ2 =
[ −χ¨− x˙Dϑ sin θ + y˙Dϑ cos θ
−η¨ − x˙Dϑ cos θ − y˙Dϑ sin θ
]
,
where µ =
r
(
Φ˙R − Φ˙L
)
2
, χ =
γR + γL
2
, ϑ =
γ˙R − γ˙L
2
.
,Ψ Ψ
D D D Ds s n cé ùx y= + ê úΨ hv
co
,
x yD D D Ds sinsin c
c Jx yD Dn csi
h Jx yD Ds sco
)f fR L g g
]
φ e+Λe
Λ
)
W
) x
z1
z2
xD
yD
Y axis
C
xM
D (target)
P
M
X axis
yM
x
P
O
MY
axis
MX
axis
Figure 2. The coordinate of the target is represented in the body coordinate system M-XY
Remark 2. If ζ1 6= 0, then h is an invertible matrix.
Let us define the position tracking error vector as e = [e1, e2]
T = ζ −ζd, where ζd is the desired
coordinate vector of the target in M-XY. According to the requirement of the position tracking control
problem mentioned above and Figure 2, one can easily set ζd = [C, 0]
T
.
The filtered tracking error vector is defined as follows
ϕ = e˙ + Λe (24)
where Λ is a 2×2 diagonal, constant, positive definite matrix and is chosen arbitrarily.
3.3. Radial basis function neural network
One cannot deny that artificial neural networks (ANN) have ability of approximating nonlinear
and sufficiently smooth functions with arbitrary accuracy. Among those ANNs, the radial basis
function neural network (RBFNN) is confirmed to be suitable for the purpose of approximating
unknown nonlinear smooth functions. In this sub-section, the RBFNN is introduced briefly. As
illustrated in Figure 3, the output of the RBFNN can be computed as follows [9]
78 TINH NGUYEN, HUNG LINH LE
y (x) = WTσ (x) (25)
where W is the weight matrix of the output layer which interconnects the hidden- with output-layer,
and σ (x) is the vector of activation functions in the hidden layer, x is the input vector of the RBFNN.
w2j
Input layer Hidden layer Output layer
x1
x2
1
j
xN1
wLj
Figure 3. Structure of RBFNN
In particular, if there are L neurons in the hidden layer and N neurons in the output layer, then
W ∈ R(L+1)×N and σ(x) ∈ R(1+L)×1 are respectively expressed as follows
W =
θ1 θ2 · · · · · · θN
w11 w21 · · · · · · w1N
w12 w22 · · · · · · w2N
...
...
...
. . .
...
wL1 wL2 · · · · · · wLN
, and σ (x) =
1
σ1
σ2
...
σL
, where θi are the threshold
offsets of the output layer (see Figure 3). It is noticeable that putting 1 into the first component of
σ (x) allows one to comprise the threshold vector [θ1, θ2, ..., θL]
T
as the first row of W. That is to
say, any tuning of W consists of tuning of both the weights wij of the connections from the hidden-
to output-layer and thresholds θij at the output-layer.
For the activation functions of the hidden layer, the Gaussian type function is employed as follows
σi = exp
(
− 1
2ρ2i
‖x−Ξi‖2
)
where Ξi and ρi are the center and width of the i-th hidden neuron, i= 1,2,. . . , L.
NEURAL NETWORK-BASED ADAPTIVE TRACKING CONTROL 79
Given any bounded and continuous function f (x) : RM → RN , there is an ideal matrix W so
that we can express f (x) as follows [9]
f (x) = y (x) + ε = WTσ (x) + ε, (26)
where ε ∈ RN×1 is a vector illustrating reconstruction errors.
Assumption 1. With a large enough number L of the hidden-layer neurons, there exists bε such
that ‖ε‖ ≤ bε.
An approximation of f (x) is revealed by fˆ (x) = Wˆ
T
σ (x), where Wˆ is an estimation matrix of
W and is provided by an online weight tuning algorithm to be discussed subsequently.
The function approximation error vector is computed by
f˜ = f (x)− fˆ (x) = WTσ (x) + ε − WˆTσ (x) . (27)
3.4. Controller structure and error system dynamics
In (23), since directly depending on the accelerations and velocities of the wheel slips which are
not measured in this work, Ψ2 is unknown. Therefore, let us define an auxiliary variable which can
be measured easily as follows
v˙c = h
−1
(
−ζ˙d + Λe˙ + Ψ1
)
. (28)
Alternatively, one can rewrite (20) as follows
Mv˙ = τ − Bv− d (29)
where d = B¯v + Qγ¨ + Cωη˙ + Gη¨ + τ d.
Subtracting Mv˙c from both of the sides of (29) and then combining the result and (23), (24),
and (28) leads to
− Mh−1ϕ˙ = τ −Mv˙c − Bv− d−Mh−1Ψ2. (30)
However, it is difficult to exactly know the parameters of the dynamic model of this WMR such
as mass, moments of inertia, etc. Consequently, it is impossible to precisely describe all expressions
including these quantities. For this reason, let Mˆ be an approximation of M. One can rewrite (30)
as follows
− Mˆh−1ϕ˙ = τ − M˜h−1ϕ˙ −Mv˙c −Bv− d−Mh−1Ψ2, (31)
where M˜ = M− Mˆ.
Remark 3. It should be noted that both M, Mˆ are always symmetric, invertible, positive definite
matrices.
Multiplying both of the sides of (31) by −hMˆ−1 yields
ϕ˙ = −hMˆ−1τ + f (x) + ∆, (32)
where f (x) = hMˆ
−1
(Mv˙c + Bv), and ∆ = hMˆ
−1 (
M˜h
−1
ϕ˙ + d + Mh−1Ψ2
)
.
80 TINH NGUYEN, HUNG LINH LE
The vector x demanded so as to calculate f (x) can be determined by x =
[
vT v˙Tc
]T
. Clearly,
x can be measured easily.
In (32), f (x) can be approximated by the RBFNN described by (26). Therefore, one can choose
a torque-computing control law as follows
τ = Mˆh
−1
(
Kϕ + Γ
ϕ
‖ϕ‖ + fˆ
)
(33)
where K is a 2×2 diagonal, constant, positive definite matrix and can be chosen arbitrarily. fˆ is the
output of the RBFNN described by (??) and is an estimation of f (x) in (32). Γ
ϕ
‖ϕ‖ is a robust term
which is used to overcome the model uncertainties, unknown external disturbances, and the unknown
wheel slips described by ∆ in (32). Γ is a positive constant value and can be selected arbitrarily.
K ˆ
)
φ
Δ G
( )-G
)ˆ( ) (
T-G
W ˆ= -
T= -
H ) a H
a
Δ b Δ
φ
W φ
K G
Controller
WMR
subject to
unknown
wheel slip
Target
(xD, yD)
e j
+
-
Computing
(22)
RBFNN
v
Equation
(28)
Figure 4. Scheme of control system
Combining (33) and (32) yields:
ϕ˙ = −Kϕ −Γ ϕ‖ϕ‖ + f˜ (x) + ∆ (34)
where f˜ (x) = f (x)− fˆ (x) is represented in (27).
Substitution of (27) into (34) makes the filtered tracking error dynamics become
ϕ˙ = −Kϕ −Γ ϕ‖ϕ‖ + W˜
T
σ + ε + ∆ (35)
where W˜ as the weight deviation by W˜ = W− Wˆ.
With such structure of the RBFNN, a suitable tuning rule for the weights should be determined
to train the RBFNN. In this work, let us propose the online weight tuning algorithm for the RBFNN
as follows
˙ˆ
W = HσϕT (36)
where H is a (L+ 1)× (L+ 1) positive definition constant matrix. H can be chosen arbitrarily.
Assumption 2. It is assumed that ∆ is bounded. Let b∆ be the upper bound of ∆. It means that
‖∆‖ ≤ b∆.
NEURAL NETWORK-BASED ADAPTIVE TRACKING CONTROL 81
Theorem 1. Let us consider the WMR subjected to the wheel slips with the dynamics shown
as (20). Let assumptions 1-3 hold. Let us choose the control input as (33) and the scheme of
the whole system as Figure 4. Let us provide the weight tuning algorithm by (36). By doing
this, the filtered tracking error vector ϕ uniformly ultimately converge to an arbitrarily small
neighborhood of the origin. Moreover, ϕ can be made be as small as possible by choosing K
and Γ to be suitable.
Proof.
Let us define a Lyapunov candidate function as follows
V =
1
2
ϕTϕ +
1
2
tr
(
W˜
T
H−1W˜
)
, (37)
where tr(.) is the trace of matrix.
Taking the first derivative with respective to time yields
V˙ = ϕT ϕ˙ + tr
(
W˜
T
H−1 ˙˜W
)
. (38)
Due to, (38) becomes
V˙ = ϕT ϕ˙ − tr
(
W˜
T
H−1 ˙ˆW
)
. (39)
Substitution of (35) and (36) into (39) results in
V˙ = ϕT
[
−Kϕ −Γ ϕ‖ϕ‖ + W˜
T
σ + ε + ∆
]
− tr
[
W˜
T
σϕT
]
. (40)
Due to ϕTW˜
T
σ = tr
(
W˜
T
σϕT
)
, (40) becomes
V˙ = −ϕTKϕ −Γ ‖ϕ‖ −ϕTε −ϕT∆. (41)
According to Assumption 1, Assumption 2, one can easily obtain the following inequality
V˙ ≤ −‖ϕ‖ [Kmin ‖ϕ‖+ Γ − bε − b∆] , (42)
where Kmin is the minimum singular value of K.
Observing (42) reveals that V˙ is guaranteed to be negative definiteness as long as the term in
the braces is positive. This term is assured to be positive as long as
Kmin ‖ϕ‖+ Γ > bε + b∆. (43)
Therefore, applying Lyapunov criteria and LaSalle extension results in that ϕ is uniformly ulti-
mately bounded in a compact set as follows
U = {ϕ |Kmin ‖ϕ‖+ Γ ≤ bε + b∆ } . (44)
It is remarkable to note that both ϕ can be made be as small as possible by choosing K, and
Γ suitably. Particularly, the bigger K and Γ are, the smaller ϕ is. This illustrates the uniformly
ultimately bounded property of ϕ in the sense of Lyapunov and LaSalle extension.
As a result of convergence of ϕ to an adjustable small neighborhood of the origin, the position
tracking error e in (24) also has converged to an adjustable small neighborhood of the origin.
82 TINH NGUYEN, HUNG LINH LE
(N.m)
)
2
)
0 1 2 3 4 5 6 7 8 9 10
0
0.1
0.2
0.3
0.4
time (s)
v
e
lo
c
it
ie
s
o
f
w
h
e
e
l
s
lip
(
m
/s
)
velocities of wheel slip
longitudinal slip of the right wheel
longitudinal slip of the left wheel
lateral slip
Figure 5. The evolutions of wheel slip
4. SIMULATION AND DISCUSSION
To verify the proposed control law, we have implemented a simulation for trajectory tracking of
the WMR whose parameters is shown in Table 1 in the presence of the unknown wheel slips. In the
initial condition, assume that the initial posture of M in the global coordinate system is xM = 0 (m),
yM = 0 (m), and θ = 0.1 (rad). It infers that xP = C= 0.5 (m), yP = 0 (m). Furthermore, we
have made a comparison between the performances of this proposed control and the control method
in [14]. To represent the compensation capability of the proposed control method on the uncertainty
effects, the vector of the both model uncertainties and bounded external disturbances is assumed as
τ d =
[
3 + sin(0.5t), 2.5 + cos (0.4t)
]T
(N.m) and Mˆ = 0.7M.
The control parameters were chosen as K = diag([6, 6]), Λ = diag([2, 2]). The hidden layer
has 10 neurons. The weight tuning gain was set as H=diag(10)11×11. The initial condition of the
weight matrix was chosen to random numbers in [0, 1] as Wˆ0 = [rand(0, 1)]11×2.
The target (point D) moved with a motion equation described as follows{
xD = 6− 3 cos (0.25t)
yD = −2− 3 sin (0.25t) (45)
Without loss of generality, assume that the wheel slips between the floor and the driving wheels
have been illustrated as Figure 5.
The computer simulation results were performed by Matlab/Simulink software. Obviously, in
Figures 6 and 7, we can easily see that when the accelerations and velocities of unknown wheel slips
have not been measured and further there existed model uncertainties as well as unknown bounded
disturbances, in comparison with the tracking results and position tracking errors of the feedback
linearization control method in [14], those of the proposed control method are better. In other words,
the performance of the proposed control method is better than that of the feedback linearization
control method.
Figure 8 has shown that the outputs of the RBFNN have been bounded.
It is apparent that the position tracking error vector, e, in (24) has converged to an adjustable
small neighborhood of the origin, so ξ1 has converged to an adjustable small neighborhood of C.
NEURAL NETWORK-BASED ADAPTIVE TRACKING CONTROL 83
0 1 2 3 4 5 6 7 8 9
-3.5
-3
-2.5
-2
-1.5
-1
-0.5
0
Comparison of tracking results
X axis (m)
Y
a
x
is
(
m
)
desired trajectory of P
proposed control law
feedback linearization
Figure 6. Comparison of tracking results
0 2 4 6 8 10
-2
-1
0
1
2
3
proposed control law
time (s)
tr
a
ck
in
g
e
rr
o
rs
(
m
)
0 2 4 6 8 10
-2
-1
0
1
2
3
feeddback linearization control
time (s)
tr
a
ck
in
g
e
rr
o
rs
(
m
)
e
1
e
2
e
1
e
2
Figure 7. Comparison of tracking errors
1 2 3 4 5 6 7 8 9 10
-2
-1.5
-1
-0.5
0
0.5
1
1.5
Outputs of RBFNN
time (s)
O
u
tp
u
ts
o
f
R
B
F
N
N
RBFNN1
RBFNN2
Figure 8. Outputs of RBFNN
84 TINH NGUYEN, HUNG LINH LE
As a result, according to Remark 2, one can easily conclude that h in (28), (30), (31), and (33) is
invertible.
From these simulation results, we can conclude that the proposed control method has robustness
against the unknown wheel slips, the model uncertainties, and the unknown external disturbances.
Furthermore, all signals in the whole closed-loop system have been bounded.
Table 1. The parameters of the WMR
Symbol Quantity Value
mG The mass of the platform of the WMR 40 (kg)
IG The inertial moment of the platform about the vertical
axis through point G (Fig. 1)
4 (kg.m2)
a The distance between point G and point M (Fig. 1) 0.2 (m)
C The distance between point P and point M (Fig. 2) 0.5 (m)
mW The mass of each wheel 2 (kg)
IW The inertial moment of each wheel about its rotational
axis
0.1 (kg.m2)
ID The inertial moment of each wheel about its diameter
axis
0.05 (kg.m2)
b half-distance between two the wheels 0.3 (m)
r The radius of each wheel 0.15 (m)
5. CONCLUSIONS
In this work, well-known Lagrange formula was employed in order to derive both the kinematics
and dynamics of the nonholonomic WMR in the presence of the unknown wheel slips. Then, the
adaptive tracking controller based on the RBFNN with the online weight tuning algorithm has been
developed to allow the WMR to track the desired trajectory with the desired tracking performance.
The RBFNN functional approximation errors and the effect of the unknown wheel slips have been
dealt with in the same way as the model uncertainties as well as the unknown external disturbances,
since they all have the same influence on the closed-loop system. A priori offline train for the weights
of the RBFNN was not needed since they can be initialized without difficulty. It has been shown that
the convergence of the position tracking errors to an arbitrarily small neighborhood of the origin is
guaranteed by the standard Lyapunov theory and LaSalle extension. The results of Matlab/Simulink
simulation confirmed the effectiveness and advantage of the proposed controller.
REFERENCES
[1] H. Bach and H. Kang, “Neural network-based adaptive tracking control of mobile robots in the
presence of wheel slip and external disturbance force,” Neurocomputing, vol. 118, pp. 12 –22,
2016.
[2] L. C. Boon and W. Danwei, “Integrated estimation for wheeled mobile robot posture, velocities,
and wheel skidding perturbations,” Proc of the IEEE Int Conf on Robot and Autom, pp. 2355–
2360, 2007.
NEURAL NETWORK-BASED ADAPTIVE TRACKING CONTROL 85
[3] C. Y. Chen, T. H. S. Li, Y. C. Yeh, and C. C. Chang, “Design and implementation of an adaptive
sliding mode dynamic controller for wheeled mobile robots,” Mechatronics, vol. 19, no. 2, pp.
156–166, 2009.
[4] D. Chwa, “Sliding-mode tracking control of nonholonomic wheeled mobile robots in polar coor-
dinates,” IEEE Trans. Control Syst, vol. 12, no. 4, pp. 637–644, 2004.
[5] ——, “Fuzzy adaptive tracking control of wheeled mobile robots with state-dependent kinematic
and dynamic disturbances,” IEEE Trans. Fuzzy Syst, vol. 20, no. 3, pp. 587–593, 2012.
[6] L. Ding, H. B. Gao, Z. Q. Deng, and Z. Liu, “Slip-ratio-coordinated control of planetary explo-
ration robots traversing over deformable rough terrain,” IEEE Int Conf on Intel Robo and Syst,
pp. 4958–4963, 2010.
[7] R. Fierro and F. L. Lewis, “Control of a nonholonomic mobile robot using neural networks,”
IEEE Trans. Neur. Netw, vol. 9, no. 4, pp. 589–600, 1998.
[8] T. Fukao, H. Nakagawa, and N. Adachi, “Adaptive tracking control of a nonholonomic mobile
robot,” IEEE Trans. Robot. Autom, vol. 16, no. 1, pp. 609–615, 2000.
[9] H. Gao, X. Song, L. Ding, K. Xia, and Z. D. N. Li, “Adaptive motion control of wheeled mobile
robot with unknown slippage,” Int. J. Control, vol. 87, no. 8, pp. 1513–1522, 2014.
[10] C. B. Low and D. Wang, “Gps-based path following control for a car-like wheeled mobile robot
with skidding and slipping,” IEEE Trans. Control Syst. Technol, vol. 16, no. 2, pp. 340–347,
2008.
[11] ——, “Gps-based tracking control for a car-like wheeled mobile robot with skidding and slip-
ping,” IEEE Trans. Mechatron, vol. 13, no. 4, pp. 480–484, 2008.
[12] S. A. A. Moosavian and A. Kalantari, “Experimental slip estimation for exact kinematics mod-
eling and control of a tracked mobile robot,” Proc. IEEE/RSJ Int Conf on Intel Robo and Syst,
pp. 95–100, 2008.
[13] M. Seyr and S. Jakubek, “Proprioceptive navigation, “slip estimation and slip control for au-
tonomous wheeled mobile robots,” Proc. of the IEEE Conf. on Robot, Autom and Mecha, pp.
1–6, 2006.
[14] N. V. Tinh, N. T. Linh, P. T. Cat, P. M. Tuan, M. N. Anh, and N. P. Anh, “Modeling and
feedback linearization control of a nonholonomic wheeled mobile robot with with longitudinal,
lateral slips,” IEEE Int Conf on Autom Sci and Engi, pp. 21–24, 2016.
[15] D. Wang and C. Low, “Modeling and analysis of skidding and slipping in wheeled mobile robots:
Control design perspective,” IEEE Trans. Robot, vol. 24, no. 3, pp. 676–687, 2008.
[16] S. J. Yoo, “Approximation-based adaptive control for a class of mobile robots with unknown
skidding and slipping,” Int Jour of Cont, Autom, and Syst, vol. 10, no. 4, pp. 703–710, 2012.
[17] ——, “Adaptive neural tracking and obstacle avoidance of uncertain mobile robots with unknown
skidding and slipping,” Information Sciences, vol. 238, pp. 176–189, 2013.
Received on April 05, 2017
Revised on July 25, 2017
Các file đính kèm theo tài liệu này:
- neural_network_based_adaptive_tracking_control_for_a_nonholo.pdf