Académique Documents
Professionnel Documents
Culture Documents
Received December 14, 2012; revised February 6, 2013; accepted February 13, 2013
Copyright 2013 Lih-Chang Lin, Hao-Yin Shih. This is an open access article distributed under the Creative Commons Attribution
License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.
ABSTRACT
The complete dynamics model of a four-Mecanum-wheeled robot considering mass eccentricity and friction uncertainty
is derived using the Lagranges equation. Then based on the dynamics model, a nonlinear stable adaptive control law is
derived using the backstepping method via Lyapunov stability theory. In order to compensate for the model uncertainty,
a nonlinear damping term is included in the control law, and the parameter update law with -modification is considered
for the uncertainty estimation. Computer simulations are conducted to illustrate the suggested control approach.
Keywords: Mecanum-Wheeled Mobile Robot; Dynamics Model; Backstepping Adaptive Control; Lyapunov Stability
x R cos y R cos l cos
2 2 2 2 2 2 2
x R cos y R cos l cos
2 (1)
If no slipping occurs along the contact rollers axis, the rotation speed . Hence, we have the following con-
same velocity can also be computed from the wheels straint equation for a Swedish wheel:
T
sin cos l cos xR y R r cos (2)
Since the rotation matrix representing the orientation of the inertia frame {I} with respect to the robot frame
In the direction orthogonal to the contact rollers axis, of the passive contact roller, thus we have the following
the motion is not constrained because of the free rotation velocity relation:
x R sin y R sin l sin
2 2 2 2 2 2 2
r sin rsw sw
T
cos sin l sin x R y R r sin rsw sw 0
Consider the omni-directional robot with four Mecanum shown in Table 1. From Equation (3), we have the
wheels shown in Figure 2. The angles i , i , and i of following four constraint equations for the centers of the
the mounted four Mecanum wheels, i 1, 2, 3, 4, are four Mecanum wheels:
l l 1 2 2 lsin 4
2 2
b
2 2 2 2 lsin 4
l G l XR
2
3 2 r
2 2 2 2 lsin 4
4
2 2 2 2 lsin 4 (6)
YI Wheel 3 Wheel 4
cos sin 0 x I
sin cos 0 y I
0 0 1
O XI where tan 1 b a .
Figure 2. A four-Mecanum-wheeled robot. Define the Jacobian matrix as:
Table 1. Parameters of the Mecanum wheels. The forward kinematics equation of the four-wheeled
Mecanum mobile robot can be obtained as follows:
Wheels i i i
1
1 tan 1 b a tan 1 b a 2 4 xI
2
2 tan 1 b a tan 1 b a 2 4
y
I 2 2 rJ
3
(8)
3 tan 1 b a tan 1 b a 2 4 4
1
4 2 tan 1 b a tan 1 b a 2 4 where J J T J J T is the pseudoinverse of J.
2 2 lsin 4
2 2 2.2. Dynamics of the Mecanum Robot
2 2 2 2 lsin 4 Consider the four-wheeled Mecanum mobile robot
J shown in Figure 3, where G is the geometric center with
2 2 2 2 lsin 4
position vector I rG xI yI in terms of the inertia
T
2 2 2 2 lsin 4 (7) frame {I}, and G is the mass center of the moving plat-
cos sin 0 form with relative position vector R rG G d1 d 2
T
sin cos 0
in terms of robot frame {R}. The velocity R vG of point
0 0 1
G, in terms of robot frame {R} can be expressed as
cos sin xI
xI cos y I sin xI sin y I cos
T
R
vG (9)
sin cos y I
where xI and y I are the velocity components of G frame {I}. Hence the velocity R vG of the mass center
along the X I - and YI - axes, respectively, and is the G in terms of robot frame {R} can be obtained as fol-
orientation angle of the platform relative to the reference lows:
R
vG' R vG k R R rG' G
(10)
x I cos y I sin d 2 i R x I sin y I cos d1 jR
The total kinetic energy T of the mobile robot includ- grangian L T V T can be obtained as below:
ing those of the platform and four Mecanum wheels can
be computed as below: YR Wheel 1
1
1 4 4
T mb vG'T vG' I b 2 mwi ri I i i2 (11)
2
Wheel 2
f2
2 i 1 i 1 f1
VG
XR
where mb is the mass of the platform, and mwi is the 2 Y 'R G
mass of the ith wheel, i 1, 2, 3, 4 ; I b is the moment of d1
d2
inertia of the platform about Z R axis ( parallel to Z R ) X 'R
4
through point G , and I i is the moment of inertia of G'
f3
the ith wheel about its main axis; is the rotational
YI
f4
speed of the platform, and i is the rotational speed of 3
Wheel 4
the ith wheel about its main axis; and r is the radius of
each Mecanum wheel. Since the mobile robot is assumed Wheel 3
moving in a plane, the total potential energy V 0 . As-
sume that the four Mecanum wheels are identical and O XI
thus let mwi mw , and I i I , i 1, 2,3, 4. After sub-
stituting Equation (2) and some computations, the La- Figure 3. Schematic of the Mecanum robot.
1 2 1
I b mb x I cos y I sin d 2 x I sin y I cos d1
2 2
L
2 2
1
mw x I cos sin y I sin cos 2lsin 4
2
2
2
x I cos sin y I sin cos 2lsin 4
2
x I cos sin y I sin cos 2lsin 4
1 1 2
I1 x I cos sin y I sin cos 2lsin 4
2 r2
1 1 2
I 2 x I cos sin y I sin cos 2lsin 4
2 r2
1 1 2
I 3 x I cos sin y I sin cos 2lsin 4
2 r2
1 1 2
I 4 x I cos sin y I sin cos 2lsin 4
2 r2
The dynamics model can then be derived using the the ith generalized force/torque. The generalized coordi-
Lagranges equations: nate vector of the mobile robot can be defined as:
q q1 q2 q3 xI y I . Refer to Figure 3,
T T
d L L
Fi , i 1, 2,3 (13) where fi is the contact friction force of the ith Me-
dt qi qi canum wheel with the floor, the generalized force/torque
where qi is the ith generalized coordinate, and Fi is Fi , i 1, 2,3 , can be derived as follows [13]:
4
i 4
F1 i r sgn i fi i r sgn i fi i (14)
i 1 xI i 1 x I
1 1 1 1 1
cos sin ; 2 cos sin ; 3 cos sin ; 4 cos sin .
x I r x I r x I r x I r
Thus,
1 1
F1 1 r sgn 1 f1 cos sin 2 r sgn 2 f 2 cos sin
r r
(15)
1 1
3 r sgn 3 f3 cos sin 4 r sgn 4 f 4 cos sin
r r
Similarly,
4
i 1
F2 i r sgn i fi 1 r sgn 1 f1 sin cos
i 1 y I r
1 1
2 r sgn 2 f 2 sin cos 3 r sgn 3 f3 sin cos (16)
r r
1
4 r sgn 4 f 4 sin cos
r
4
i 2
F3 i r sgn i fi 1 2 3 4 l sin 4
i 1 r (17)
sgn 1 f1 sgn 2 f 2 sgn 3 f3 sgn 4 f 4 2l sin 4
n rB B T B M
1
e1 z1 qd (24)
(34)
where qd t xI , d t , yI , d t , d t
T
is the desired 1 B T Sf e e e K 1 K e
qd M 2 2 1 2 1 1
T
V2
q
e
d rB B T B 2 rB B T B
1 1
H m w m (41)
V2
q c1
e
where c1 0 . Substituting Equations (40) and (41) into Equation (39), we have
V 1 V 1
Va 2 t , q, q q B T n 2 q B T d D1 D2 w Tm 1w m
e r e r
V2
T
q
V e
2V2 w Tm 1w m 2 q 2 H w H w D (42)
e V2 m m m m 2
q c1
e
V2
T
q
V2 e D V2 q H w w T 1w
2V2 q 2 m m m
e V2 2
e m
q c 1
e
V
T
w m w m 2 q H m w m wm0 (43)
e
where 0, and wm0 is the best guess for the unknown parameter vector wm . Since
V2
T
V2
T
V2
V2
q
q q c1
e V e e
q 2 D 2 (q) D
e V2 2
e 2 V2 2
V2
q c1 q c1 q c1
e e e
V2 V2
q q
e V2 V2 e
2 q 2 q c1 2c1 2 c1
V2 e e V2
q c1 q c1
e e
w
2 The parameters of the mobile robot are selected as fol-
Va 2 e1 e m d (47) lows: mb = 12 kg, I = 0.5 kgm2, Iw = 4.0378 104
2 kgm2, a = 0.2 m, b = 0.3 m, l = 0.25 m, mw = 0.313 kg, r
Let 2 e1 e d 0 , then e1 e d 2 , and thus = 0.0508 m, urr 0.25, and g 9.8 m/s 2 . And the ada-
w m
2
ptive controller parameters are chosen as:
e 1
d 2 be . Similarly, while d 0,
K1 diag 9000 9000 100 ,
e1
2
2d
we have w m bw . Hence, if e be or K 2 diag 2000 1800 3.25 ,
w m bw , then 0.002, c1 0.0001,
Va 0 0.002 I , w 0 0 0 0 ,
T
(48)
Since and
1 T
Va
1
e K a e w Tm 1 w m diag 8 2 4.75 .
2 2 (49) In the simulation, we consider the platform having ec-
1
e 2 e max 1 w m
2
2
centricity with d1 d 2 0.02 m, and the mass has varia-
tion mb 3 kg. The wheels contact frictions are as-
by substituting e be and w m bw into the right sumed with uncertainty
side of Equation (49), we can define
f 0.05 0.05 0.05 0.05 N .
T
d d max
Vr e 2 e11
1
Figure 4. Simulation results of the pure translational case. (a) x I , y I , and responses; (b) Tracking errors; (c) Control
torques, 1 ~ 4 N m ; (d) Compensator parameters adaptation w m t ; (e) Tracking results of geometric center,
x t , y t m .
I I
and YI -axes can be kept within 0.0257 - 0.0235 m and stable adaptive control for a four-Mecanum-wheeled
0.0143 - 0.0270 m, respectively, and the orientation robot are considered. Based on the derived 3-DOF dy-
error is within 0.0574 - 0.0362 rad. The correspond- namics model considering the platform mass variation,
ing control torques of the four Mecanum wheels are eccentricity, and friction uncertainty, a nonlinear stable
shown in Figure 5(c). The adaptation processes of the adaptive control law is derived using the backstepping
uncertainty compensation terms parameters vector w m t method via Lyapunov stability theory. A nonlinear
are shown in Figure 5(d). And the geometric centers damping term is included in the control law to compen-
displacement in X I YI plane is shown in Figure 5(e). sate for the estimation error, and the parameters adapta-
tion law with - modification is considered for the un-
5. Conclusions certainty estimation. Computer simulations are pre-
In this paper, Cartesian-space dynamics modeling and sented to illustrate the control system performance. Real
Figure 5. Simulation results of the pure rotational case. (a) x I , y I , and responses; (b) Tracking errors, (c) Control
torques, 1 ~ 4 N m ; (d) Compensator parameters adaptation w m t ; (e) Displacement of geometric center
x t , y t m .
I I
implementation study using the suggested control law Canadian Conference on Computer and Robot Vision,
with microcontroller deserves future consideration. 9-11 May 2005, pp. 544-549. doi:10.1109/CRV.2005.31
[4] O. Diegel, A. Badve, G. Bright, J. Potgieter and S. Tlale,
Improved Mecanum Wheel Design for Omni-Directional
REFERENCES Robots, Proceedings of the Australasian Conference on
[1] R. Rojas, A Short History of Omnidirectional Wheels. Robotics and Automation, Auckland, 2002, pp. 117-121.
http://robocup.mi.fu-berlin.de/buch /shortomni.pdf [5] H. Asama, M. Sato, L. Bogoni, H. Kaetsu, A. Matsumoto
[2] K.-L. Han, H. Kim and J. S. Lee, The Sources of Posi- and I. Endo, Development of an Omni-Directional Mo-
tion Errors of Omni-Directional Mobile Robot with Me- bile Robot with 3 DOF Decoupling Drive Mechanism,
canum Wheel, IEEE International Conference on Sys- IEEE International Conference on Robotics and Automa-
tems, Man and Cybernetics, 2010, pp. 581-586. tion, Nagoya, 1995, pp. 1925-1930.
[3] N. Ould-Khessal, Design and Implementation of a Robot [6] R. Siegwart, I. R. Nourbakhsh and D. Scaramuzza, In-
Soccer Team Based on Omni-directional Wheels, 2nd troduction to Autonomous Mobile Robots, 2nd Edition,
MIT Press, London, 2011. [11] J. Park, S. Kim, J. Kim and S. Kim, Driving Control of
[7] C.-C. Tsai, F.-C. Tai and Y.-R. Lee, Motion Controller Mobile Robot with Mecanum Wheel Using Fuzzy Infer-
Design and Embedded Realization for Mecanum Wheeled ence System, International Conference on Control, Auto-
Omni-Directional Robots, Proceedings of the 8th World mation and Systems, Gyeonggi-do, 2010, pp. 2519-2523.
Congress on Intelligent Control and Automation, Taiwan, [12] C.-C. Tsai and H.-L. Wu, Nonsingular Terminal Sliding
2011, pp. 546-551. Control Using Fuzzy Wavelet Networks for Mecanum-
[8] N. Tlale and M. de Villiers, Kinematics and Dynamics Wheeled Omni-Directional Vehicles, IEEE International
Modeling of a Mecanum Wheeled Mobile Platform, 15th Conference on Fuzzy Systems, 2010, pp. 1-6.
International Conference on Mechatronics and Machine [13] M. W. Spong, S. Hutchinson and M. Vidyasagar, Robot
Vision in Practice, Auckland, 2-4 December 2008, pp. Modeling and Control, Wiley, New York, 2006.
657-662. doi:10.1109/MMVIP.2008.4749608 [14] J. T. Spooner, M. Maggiore, R. Ordez and K. M. Pass-
[9] P. Viboonchaicheep, A. Shimada and Y. Kosaka, Posi- ino, Stable Adaptive Control and Estimation for Non-
tion Rectification Control for Mecanum Wheeled Omni- linear Systems: Neural and Fuzzy Approximator Tech-
Directional Vehicles, 29th Annual Conference of the IEEE niques, Wiley, New York, 2002.
Industrial Electronics Society, Vol. 1, 2003, pp. 854-859. doi:10.1002/0471221139
[10] K.-L. Han, O.-K. Choi, J. Kim, H. Kim and J. S. Lee, [15] C. K. Gau, Design, Gait Generation and Embedded Mi-
Design and Control of Mobile Robot with Mecanum- crocontroller-Based Single-Axis Servo Controller Imple-
Wheel, ICROS-SICE International Joint Conference, Fa- mentation for a Biped Walking Robot, Master Thesis,
kuoka International Congress Center, Japan, 2009, pp. National Chung Hsing University, Taichung, 2007.
2932-2937.