Brief Paper Output Feedback Controller Design of A Unicycle-Type Mobile Robot With Delayed Measurements
Brief Paper Output Feedback Controller Design of A Unicycle-Type Mobile Robot With Delayed Measurements
Brief Paper Output Feedback Controller Design of A Unicycle-Type Mobile Robot With Delayed Measurements
org
Published in IET Control Theory and Applications
Received on 13th October 2010
Revised on 12th April 2011
doi: 10.1049/iet-cta.2010.0591
ISSN 1751-8644
Brief Paper
Output feedback controller design of a unicycle-type
mobile robot with delayed measurements
E.-H. Guechi J. Lauber M. Dambrine M. Defoort
UVHC-LAMIH, CNRS UMR 8201, Univ Lille Nord de France Le Mont Houy, F59313 Valenciennes, France
E-mail: [email protected]
Abstract: This study deals with the trajectory tracking controller design of a wheeled mobile robot subject to delayed
measurements. Using the atness properties of the unicycle-type mobile robot, an output feedback approach based on a
non-linear predictor to estimate the state variables is proposed. It enables one to guarantee the exponential stability of
the tracking errors. A nite-time observer based on sliding mode theory is applied for the estimation of the delay whose
value is assumed to be constant but unknown. The stability property of the closed-loop system with delayed outputs is
studied using the Lyapunov theory. Numerical simulations in a realistic environment show the efciency of the proposed
approach.
Introduction
2
2.1
Problem statement
Kinematic model
www.ietdl.org
Let us dene the tracking errors of the robot as
Fig. 1
(1)
(t) = w(t)
(6)
(7)
(2)
where the control inputs of the mobile robot v(t) and w(t)
are, respectively, the linear and the angular velocities of
the robot.
Remark 1: System (2) is differentially at (see [8] for details
about atness) since all inputs and state variables can be
differentially parameterised by x(t), y(t) as well as a nite
number of their time derivatives, that is
y (t)
(t)
=
arctan
x (t)
2
(3)
v(t) = x (t) + y 2 (t)
2.2
(5)
Control objective
(4)
where vr (t) and wr (t) are the linear and angular velocities
of the virtual robot, respectively. In this paper, it is assumed
that the reference trajectory, its rst and second time
derivatives are bounded.
Remark 2: A recent algorithm based on a receding horizon
planner enables the real-time generation of the optimal
admissible trajectory which takes into account the physical
capacities of the robot and the environment (see [18, 19] for
further details).
IET Control Theory Appl., 2012, Vol. 6, Iss. 5, pp. 726733
doi: 10.1049/iet-cta.2010.0591
www.ietdl.org
Fig. 2
(8)
2 ,
1 |w(t)|
t with 1 , 2 > 0
(9)
if > 0
1
sign() = 0
if = 0
1 if < 0
(10)
(11)
(t)
= w(t
) w(t
(t)) + (t)w(t
(t))
(12)
and |w(t
)| 2
(14)
crosses zero
during a small interval of time. In such a case, the proposed
observer keeps the last estimated value of the delay. Then,
when w(t)
d x (t)
L1 (x(t ) x (t (t)))
dt
d y (t)
L2 (y(t ) y (t (t)))
= v(t) sin (t)
dt
d (t) = w(t) L3 ( (t ) (t
(t)))
dt
(16)
x (t)
cos( (t)) sin( (t))
v (t)
=
(17)
y (t)
sin( (t)) cos( (t))
v(t)w(t)
Since (t) is not known, let us use its estimated value (t)
in order to design the classical feedback linearising control
IET Control Theory Appl., 2012, Vol. 6, Iss. 5, pp. 726733
doi: 10.1049/iet-cta.2010.0591
www.ietdl.org
laws u1 (t) and u2 (t) as follows
u1 (t) = v (t) cos( (t)) v(t)w(t) sin( (t))
u2 (t) = v (t) sin( (t)) + v(t)w(t) cos( (t))
0
0
0
0
k (t) k (t) k (t) k (t)
2 1
1 2
2 2
1 1
A(t) =
0
0
0
0
k1 2 (t) k2 2 (t) k1 1 (t)
k2 1 (t)
1 (t) = 1 + cos((t))
2 (t) = sin((t))
(t)
+
k
y
(t)
+
k
y
+
(t)(
y
r
1
2
2
(18)
Closed-loop stability
x (t)
cos( (t) (t)) sin( (t) (t)) u1 (t)
=
y (t)
sin( (t) (t)) cos( (t) (t)) u2 (t)
(20)
Let us dene the observation error as follows
(21)
e x (t)
k1 ex (t) + k2 e x (t)
cos( (t)) sin((t))
=
+
e y (t)
k1 ey (t) + k2 e y (t)
sin( (t)) cos((t))
k1 x (t) k2 x (t)
k1 y (t) k2 y (t)
1 + cos( (t))
sin( (t))
+
sin( (t))
1 + cos( (t))
(22)
y r (t) + k1 ey (t) + k2 e y (t)
which can be rewritten on the form of a perturbed linear
system
X (t) = AX (t) + A(t)X (t) + (t)
(23)
with
X (t) = [ex (t), e x (t), ey (t), e y (t)]T ,
0
0 1 0 0
(t)
0 0
k k
2
A= 1 2
, (t) =
0 0 0 1
0
0 0 k1 k 2
(t)
4
with
(24)
(26)
= L ( (t ) (t
(t)))
(t)
3
(27)
(25)
(28)
(29)
(30)
(31)
www.ietdl.org
derive that these terms converge also exponentially towards
zero. That is to say, there are positive real numbers C1 , C2 ,
such that, for all t t0 , one obtains
A(t) < C1 et
(t) C2 et
t0
e( )t e( )t0
(34)
Simulation results
Fig. 3
Trajectory tracking with delayed and noise measurements: actual and reference trajectories of the robot
Fig. 4
730
The Institution of Engineering and Technology 2012
(33)
(t, h)(h) dh
e (th) eh dh
t0
Let
(t, t0 ) be the transition matrix of the system
X (t) =
(t, t0 )X (t0 ) +
t
www.ietdl.org
Fig. 5
Fig. 6
Fig. 7
731
The Institution of Engineering and Technology 2012
www.ietdl.org
Fig. 8
Fig. 9
Convergence of the estimated delay towards the actual delay using the sliding mode observer
www.ietdl.org
Fig. 10
Conclusion
Acknowledgments
7
1
2
3
4
5
6
7
8
References
Laumond, J.-P.: Robot motion planning and control (SpringerVerlag, 1998)
Brockett, R.W.: Asymptotic stability and feedback stabilization, in
Brockett, R.W., Millman, R.S., Sussmann, H.J. (Eds.): Differential
geometric control theory (Birkhauser, Boston, MA, 1983), pp. 181
195
Pomet, J.: Explicit design of time-varying stabilizing control laws for
a class of controllable systems without drift, Syst. Control Lett., 1992,
18, (2), pp. 147158
Samson, C.: Control of chained systems: application to path following
and time-varying point-stabilization of mobile robots, IEEE Trans.
Autom. Control, 1995, 40, pp. 6477
Oriol, G., De Luca, A., Vendittelli, M.: WMR control dynamic
feedback linearization: design, implementation, and experimental
validation, IEEE Trans. Control Technol., 2002, 10, (6), pp. 835852
Murray, R., Sastry, S.: Nonholonomic motion planning: steering using
sinusoids, IEEE Trans. Autom. Control, 1993, 38, (5), pp. 700716
Hespanha, J.P., Morse, A.S.: Stabilization of nonholonomic
integrators via logic-based switching, Automatica, 1999, 35, (3),
pp. 385393
Fliess, M., Levine, J., Martin, P., Rouchon, P.: Flatness and defect of
nonlinear systems: introductory theory and examples, Int. J. Control,
1995, 61, (6), pp. 13271361
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26