kelouwani2010
kelouwani2010
Abstract— Most differential drive platforms are equipped of the casters when driving backward; however, no controller
with two independent motors and casters. Possible misalign- structure was proposed. In [2], a fuzzy logic based controller
ment between the platform direction and caster orientations was proposed to improve a differential platform motion on
and the unbalanced motor dynamics are some of the factors
that make it difficult to properly drive the platforms. We present an inclined surface. Here again, no straightforward platform
an adaptive nonlinear controller system that reduces the effect mobile controller was derived and the stability of the over-
of disturbances on the platform motion. The controller system all control strategy was not provided. In [9], a simulated
has two main parts: (1) a kinematic controller based upon Lya- model of a mobile platform was proposed and a fuzzy
punov’s stability theory and (2) a dynamic compensator based logic control was derived. This controller aimed to keep the
upon the reference model approach in order to allow robust
trajectory tracking. Both controllers have been implemented platform stationary when the front casters are lifted, but no
and tested on two different types of powered wheelchairs. The evidence was provided about the stability scheme. Moreover,
results suggest that the proposed nonlinear controllers provide no experimentation was provided to assess the controller
better trajectory tracking performance than well-known PID operations. Astolfi [11] has proposed an exponentially stable
controllers. wheeled mobile robot dynamic controller by assuming that
I. INTRODUCTION the motor dynamics is fully compensated. However, in real
applications, this assumption is not always true. We pro-
The propulsion of a differential drive mobile platform
pose in this paper an adaptive and straightforward design
is usually done by two independent motors. The control
approach of nonlinear kinematic and dynamic controllers
of the platform configuration (position and orientation) is
that reduce significantly the effect of disturbances on the
challenging because it has non-holonomic constraints and
platform motion. This approach is related to the general
the motors are behaving under nonlinear dynamics. Usually,
stabilizing algorithm proposed in [12]. Furthermore, exten-
front and rear casters are added to the platform for stability
sive experiments on two powered wheelchairs with different
purpose. During the motion, these casters’ orientations can
drives, a centrally driven and a rear drive, are presented.
cause disturbances, as well as the type of navigation surface,
The rest of the paper is organised into 5 sections. Section
the varying load, the location of the center of gravity and
2 presents the differential drive platform dynamic model.
the center of gyration estimates [1], [2]. Several approaches
In section 3, the problem is formulated, whereas section 4
have been used to reduce the impact of perturbations in
discusses the adaptive nonlinear controller design approach.
general. But few of them have proposed a straightforward
Experimentation and conclusion are presented in section 5
design approach to limit the effect of such disturbances.
and section 6, respectively.
Recently, Dan [3] has proposed a review of the most used
control systems for the differential drive: speed control [4], II. D IFFERENTIAL -D RIVE P LATFORM DYNAMIC M ODEL
traction control [5], [6], active suspension control and sta-
bility control. She outlined the lack of a straightforward and Based upon Newton-Euler equation the following dynamic
robust design approach. Among speed controllers commonly model is obtained:
used, the Proportional-Integral-Derivative (PID) controller
M(Q)Q̈ +C(Q, Q̇)Q̇ + G(Q) = B(Q)Γ (1)
[7], [9] is the most implemented. Knowledge of the kinematic
model of the platform is required to set the PID coefficients with the following non-holonomic constraint:
[10]. However, this knowledge is not always accurate and
operation conditions (slope, navigation surface, front and J(Q)Q̇ = 0 (2)
rear caster orientations, etc.) may change during the motion.
where Q = [X,Y, θ ] , (X,Y ) and θ are, respectively, the
To allow the PID control system to adapt to such changing
configuration vector, the coordinates of the center of gyration
conditions, the PID coefficients must be continuously mod-
and the orientation of the platform as shown in Figure 1.
ified. However, stability of these adaptive schemes is not
M(Q) is a (3 × 3) matrix of the system mass and inertia.
provided [4]. In [1], the author proposed a dynamic model
C(Q, Q̇) is a (3 × 1) vector of the Coriolis and centripetal
of a differential drive platform that considers the orientation
forces, G(Q) is a (3 × 1) vector of the gravitational forces
The authors are with the Perception and Robotic and torques. Γ = [τl , τr ] is a (2 × 1) vector of the motors
Laboratory, École Polytechnique de Montréal, Québec, input torques (left and right). B(Q) is the (3 × 2) input
Canada [email protected],
[email protected], transformation matrix. J(Q) is the Jacobian matrix of the
[email protected] system. Since the platform is moving on a 2D surface,
1239
C. Nonlinear Kinematic Controller where:
t
The goal of the Nonlinear Kinematic Controller is to K1 (θe ) = α θe dt , α ∈ [0, 1] (18)
generate [vt , ωt ] by assuming that the platform dynamic is 0
1240
a) Reference Model: If m is known exactly and if there 2) Angular velocity Dynamic Controller: As a result of
is no disturbance, then: the design approach presented in section IV-E.1, the refer-
ence model ωm is represented by:
vm = vtr (23)
ω̇m = ω˙tr + λω (ωtr − ωm ) (33)
Taking the Laplace transform of Equation23 yields:
where λω is a constant that depends upon the system
s + λv r dynamic. The angular acceleration control law is given by:
vm (s) = vtr (s) ⇔ vm (s) = v (s) (24)
s + λv t
ω̇ = θ3 ω˙tr + θ4 λω (ωtr − ω) (34)
where λv is a constant that depends mainly on the platform
dynamic transfer function. By rewriting this equation in the where θ3 and θ4 are parameters to be adapted. The angular
time domain, we get the expression of the reference model velocity error is:
of the linear velocity:
eω = ω − ωm (35)
v̇m = v˙tr + λv (vtr − vm ) (25)
Let us assume that φ3 = (1 − θ3 ) and φ4 = (λω − θ4 ).
b) Linear velocity Reference Model Tracking: Given Equation 36 represents a Lyapunov function candidate.
the reference model 25, a control law that must allow a good 1 1 1
and stable tracking of v̇m must be adopted. In order to follow Vω (eω , θ3 , θ4 ) = (e2ω + φ32 + φ42 ) (36)
2 γω γω
v̇m , we propose the following control law:
The adaptive law is given by the following two expressions:
v̇ = θ1 v˙tr + θ2 λv (vtr − v) (26)
t
θ3 = −γω eω ω˙tr dt (37)
where θ1 and θ2 are control parameters that must be adapted 0
in order to follow v̇m . Note that perfect tracking occurs when
v = vtr and θ1 = 1. Based upon Equations 25 and 26, the t
adaptation error is represented by: θ4 = −γω eω (ωtr − ω) dt (38)
0
1241
Figures 5 and 6 show the error between the input velocity and
the platform velocity. Both controllers (PID and nonlinear)
errors are bounded in a small interval. However, the angular
correction introduced by the nonlinear controllers is more
important compared to the same correction applied by the
PID, in order to maintain a good linear motion tracking
(Figure 6).
1242
When the nonlinear controller are used, the results are
similars to the one obtained with the middle drive platform:
RSMEX and RSMEY are repectively 0.15 and 0.11.
Fig. 7. Setup for Robustness Testing 2) Curvilinear Motion: In Figure 10 the trajectory de-
scribed when using nonlinear controllers is closer to the
reference trajectory than is the one obtained with PID con-
trollers. However, the obtained trajectory following results on
the middle wheel wheelchair are better than the one obtained
with the rear-wheel wheelchair. Recall that in Section III,
we made the assumption that the locations of the center of
gyration and the center of gravity are the same. Although
this assumption is not true when using the rear driven
wheelchair, the proposed controllers performed better than
PID controllers.
VII. ACKNOWLEDGEMENT
This work has been supported by the Natural Science and
Engineering Research Council of Canada (Grant No CRD
349481-06 Scholarship No BESC D3-348674-2007). The
Fig. 9. Middle-Wheel Powered Wheelchair: Comparison of Controllers for
Curvilinear Trajectory Following collaboration and support of Robovic Inc., Sunrise Medical
Canada are as well gratefully acknowledged. The authors
wish to thank Hai Nguyen, Patrice Boucher, Vincent Zalzal,
E. Experiment 4: Rear Driven Wheelchair Control Raphael Gava and Alexandre Fortin from the Perception
1) Straight Line Motion: With the rear drive wheelchair and Robotics Laboratory of Ecole Polytechnique for their
Quicky 646, we performed the straightforward motion test. contributions on implementation and testing.
1243
R EFERENCES
[1] D. Ding, R. A. Cooper, S. Guo and T. A. Corfman, ”Analysis of Driv-
ing Backward in an Electric-Powered Wheelchair”, IEEE Transaction
on Control Systems Technology, (12)6,934-943, 2004.
[2] Murakami, H., Seki, H, Minakata, H, Tadakuma, S, ”Operationality
improvement control of electric power assisted wheelchair by fuzzy
algorithm”, 2009 IEEE International Conference on Industrial Tech-
nology, 2009.
[3] Dan Ding, Rory A. Cooper, ”Electric-powered wheelchairs- A review
of current technology and insight into feature directions”, IEEE
Control System Magazine, 22-34, 2005.
[4] L. Boquete, R. Garcia, R. Barea and M. Mazo, ”Neural Control of
the Movements of a Wheelchair”, Journal of Intelligent and Robotic
Systems, 213-226, 1999.
[5] Makki A. and Siy P., ”A robust traction controller design using
the theory of variable structure systems”, Proc. 36th Midwest Symp.
Circuits and Systems, Detriot, MI, 356-359, 1993.
[6] Venkat Krovi and Vijay Kumar, ”Optimal Traction Control In A
Wheelchair With Legs And Wheels”, Proc. 4th Ann. Applied Mecha-
nisms and Robotics Conference, AMR- 030, (30), 1995.
[7] Ruei-Xi Chen, Liang-Gee Chen and Lilin Chen, ”System Design
Consideration for Digital Wheelchair Controller”, IEEE Transaction
on Industrial Electronis, (47)4,898-907, 2000.
[8] Kanayama, Y., Kimura, Y., Miyazaki, F., Noguchi, T., ”A Stable
Tracking Control Method for an Autonomous Mobile Robot”, IEEE
International Conference on Robotics and Automation, (1), 384-389,
1990.
[9] S. Ahmad and M.O. Tokhi, ”Modelling and Control of a Wheelchair
on Two Wheels”, Second Asia International Conference on Modelling
and Simulation, 579-584, Kuala Lumpur, Malaysia, 2008.
[10] Brown, K.E. Inigo, R.M. Johnson, B.W., ”Design, Implementation, and
Testing of an Adaptable Optimal Controller or an Electric Wheelchair”
Industry Applications Society Annual Meeting, (2),2332-2339, San
Diego, CA, 1989.
[11] stolfi, A., ”A robustly stabilising adaptive controller for systems
in feedback form” Journal of Dynamic Systems, Measurement, and
Control, (121)121-126 2006.
[12] Karagiannis, D. Astolfi, A., ”A robustly stabilising adaptive controller
for systems in feedback form” American Control Conference, 3557-
3562 2006.
[13] Kanayama Y. and Miynke N. ”Theory of two-dimensional transforma-
tions”, IEEE Trans. Robot. Autom. (14), 827-834, 1998.
[14] Jin-Xia Y. Zi-Xing C. Zhuo-Hua D., ”Dead reckoning of mobile robot
in complex terrain based on proprioceptive sensors ” International
Conference on Machine Learning and Cybernetics, (4), 1930-1935,
2008.
[15] Kanayama, Y. Nilipour, A. Lelm, C.A. ”A Locomotion Control
Method for Autonomous Vehicles”, IEEE International Conference
on Robotics and Automation, (2)1315-1317, Philadelphia, PA, USA,
1988.
[16] Shankar Sastry and Marc Bodson ”Adaptive Control: Stability, Con-
vergence, and Robustness”, Prentice-Hall Advanced Reference Series
(Engineering), New Jersey, 1994.
1244