Professional Documents
Culture Documents
ABSTRACT 2. KINEMATIC
This paper introduces omnidirectional Mecanum wheels and Figure 2 shows the configuration of a robot with four
discusses the kinematic relations of a platform used four omnidirectional wheels.
Mecanum wheels. Forward and Inverse kinematic is been
derived in this paper. Experimental and analytically results are
obtained and 8 different motions without changing the robot’s
orientation is achieved.
Keywords
Omnidirectional, four Mecanum wheeled robot, mobile robot,
kinematic.
1. INTRODUCTION
Omni-differential locomotion is being using in current mobile
robots in order to obtain the additional maneuverability and
productivity. These features are expanded at the expense of
improved mechanical complication and increased complexity
in control mechanism. Omni-differential systems work by
applying rotating force of each individual wheel in one
direction similar to regular wheels with a different in the fact
that Omni-differential systems are able to slide freely in a Fig 2: Wheels Configuration and Posture definition
different direction, in other word, they can slide frequently The configuration parameters and system velocities are
perpendicular to the torque vector. The main advantage of defined as follows:
using Omni-drive systems is that translational and rotational
motions are decoupled for simple motion although in making 𝑥, 𝑦, 𝜃, robot’s position (x, y) and its orientation angle θ
an allowance for the fastest possible motion this is not (The angle between X and 𝑋𝑅 );
essentially the case.
X G Y, inertial frame; x,y are the coordinates of the reference
1.1 Mecanum Wheels point O in the inertial basis;
Mechanum wheel also called Ilon wheel and Swedish wheel is 𝑋𝑅 𝑂𝑌𝑅 , robot’s base frame; Cartesian coordinate system
a more common omnidirectional wheel designs, invented in associated with the movement of the body center;
1973 by Bengt Ilon a Swedish engineer [1]. In this design,
similar to the Omni wheel, There are a series of free moving 𝑆𝑖 𝑃𝑖 𝐸𝑖 , coordinate system of ith wheel in the wheel’s center
rollers attached to the hub but with an 45° of angle about the point 𝑃𝑖 ;
hub's circumference but still the overall side profile of the
wheel is circular. See Figure 1[2]. O, 𝑃𝑖 , the inertial basis of the Robot in Robot’s frame and
𝑃𝑖 = {𝑋𝑃𝑖 , 𝑌𝑃𝑖 } the center of the rotation axis of the wheel 𝑖 ;
Omnidirectional motion can be reached by mounting four
Mecanum wheels on the corners of a four-sided base. Because 𝑂𝑃𝑖 , is a vector that indicates the distance between Robot’s
of the angled rollers, the mechanical design is much more center and the center of the wheel 𝑖th;
difficult, but due to the smoother transfer of contact surfaces a
higher loads can be supported [3]. 𝑙𝑖𝑥 , 𝑙𝑖𝑦 , 𝑙𝑖𝑥 , half of the distance between front wheels and 𝑙𝑖𝑦
half of the distance between front wheel and the rear wheels.
𝑙𝑖 , distance between wheels and the base (center of the robot
O);
𝑟𝑖 , denotes the radius of the wheel i (Distance of the
wheel’s center to the roller center)
𝑟𝑟 , denotes the radius of the rollers on the wheels.
𝛼𝑖 , the angle between O𝑃𝑖 and XR ;
Fig 1: Mecanum wheel design
6
International Journal of Computer Applications (0975 – 8887)
Volume 113 – No. 3, March 2015
𝑣𝑖𝑟 , the velocity of the passive roller in the wheel i; From (eq.3) and (eq.5), the inverse kinematic model can be
obtained:
.[𝑤𝑠𝑖 𝑤𝐸𝑖 ωi ]T , Generalized velocity of point 𝑃𝑖 in the 𝑣𝑋𝑅
frame 𝑆𝑖 𝑃𝑖 𝐸𝑖 ; 𝜔𝑖
𝑤 𝑖 𝑇 𝑃𝑖 𝑇
= 𝑇′ 𝑣𝑌𝑅 , 𝑖 = 0,1,2,3. eq. 8
𝑃𝑖 𝑅 𝑣𝑖𝑟
[𝑣𝑆𝑖 𝑣𝐸𝑖 ωi ]T, Generalized velocity of point 𝑃𝑖 in the frame 𝜔𝑅
𝑋𝑅 𝑂𝑌𝑅 ; As𝑟𝑖 ≠ 0 , 0 < 𝛾𝑖 < 𝜋 2 , 𝑑𝑒𝑡 𝑃𝑖 𝑇𝑅 ≠ 0, 𝑑𝑒𝑡 𝑤 𝑖 𝑇𝑃𝑖 ≠
𝑣x, 𝑣y [m/s] - Robot linear velocity; 0 hence, by merging equations 4 and 6 the robot’s base
velocity (at point O) related to the rotational velocity of the ith
𝜔𝑧 [rad/s] - Robot angular velocity; wheel can be obtained from eq. 9.
𝑣𝑋𝑅
𝜔𝑖 𝑤 𝑖 𝑇 −1 . 𝑃𝑖 𝑇 −1 . 𝑇′ 𝑣𝑌𝑅 , 𝑖 = 0,1,2,3.
𝑣𝑖𝑟 = 𝑃𝑖 𝑅 eq. 9
𝜔𝑧
According to eq.3 and eq.4 there is a relationship between
variables in each robot’s wheels frames and its center. And
with the inverse kinematic, the velocity of the system can be
obtained by implementing 𝑣ir the linear velocity and i the
rotational speed of wheel ith in eq.10 and the contrary in
eq.11.
𝒗𝑿𝑹
𝝎
Fig 3: Parameters of ith wheel 𝒗𝒀𝑹 = 𝑻+ 𝒊 eq. 10
𝒗𝒊𝒓
𝝎𝒛
According to Figure 3(b), we can calculate the velocity of the
𝒗𝑿𝑹
wheel i and the tangential velocity of the free roller attached 𝝎𝒊
= 𝑻 𝒗𝒀𝑹 eq. 11
to the wheel touching the floor: 𝒗𝒊𝒓
𝝎𝑹
1
𝑣𝑖𝑟 = 𝑟𝜔 , 𝑤𝐸𝑖 = 𝑟𝑖 𝜔𝑖 [4], 𝑖 = 0,1,2,3. eq. 1
𝑐𝑜𝑠 45 𝑟 𝑖 Where 𝑇 = 𝑤 𝑖 𝑇 −1 . 𝑃𝑖 𝑇 −1 . 𝑇′, 𝑇 + = (𝑇 𝑇 𝑇)−1 𝑇 𝑇 .
𝑃𝑖 𝑅
According to Figure 3(b) and considering the equations −1 −1
(eq.1) , the velocity of the wheel 𝑖 in the frame 𝑆𝑖 𝑃𝑖 𝐸𝑖 , can be cos 𝛽𝑖 − sin 𝛽𝑖 0 sin 𝛾𝑖 1 0 −𝑙𝑖𝑦
𝑇= . .
derived by: sin 𝛽𝑖 cos 𝛽𝑖 𝑟𝑖 cos 𝛾𝑖 0 1 𝑙𝑖𝑥
𝑣𝑆𝑖 = 𝑣𝑖𝑟 sin 𝛾𝑖 . Considering the fact that 𝑙𝑖𝑥 = 𝑙𝑖 cos𝑎𝑖 and 𝑙𝑖𝑦 = 𝑙𝑖 𝑠𝑖𝑛𝑎𝑖 , and
assuming that the wheels are in a same size, the
𝑣𝐸𝑖 = 𝜔𝑖 𝑟𝑖 + 𝑣𝑖𝑟 cos 𝛾𝑖 . transformation matrix is:
𝑣𝑆 𝑖 0 sin 𝛾𝑖 𝜔𝑖 𝑤𝑖 𝑇
𝜔𝑖
= 𝑣𝑖𝑟 = 𝑃𝑖 𝑣𝑖𝑟 . eq. 2
𝑣𝐸 𝑖 𝑟𝑖 cos 𝛾𝑖 eq. 12
The transformation matrix from velocities of the ith wheel to
its center:
𝑤𝑖 𝑇 0 sin 𝛾𝑖
𝑃𝑖 = . eq. 3
𝑟𝑖 cos 𝛾𝑖
According to Figure 3(a) and Figure 2, the velocity of the
wheel’s center translated to the XROYR coordinate system can
be achieved by equation 7.
𝑣𝑖𝑋 𝑅 cos 𝛽𝑖 − sin 𝛽𝑖 𝑣𝑆 𝑖 𝑤 𝑖 𝑇 𝑃𝑖 𝑇
𝜔𝑖
= = 𝑃𝑖 𝑅 𝑣𝑖𝑟 . eq. 4 eq. 13
𝑣𝑖𝑌 𝑅 sin 𝛽𝑖 cos 𝛽𝑖 𝑣𝐸 𝑖
Then, the transformation matrix from the ith wheel’s center to Since there is a relation between independent variables 𝑣𝑖𝑟
the robot coordinate’s system can be obtained from equation and 𝜔𝑖 in each joint and the systems angular and linear
5. velocity, assuming that there is no wheel slipping on the
ground, the system inverse kinematic can be obtained by
𝑃𝑖 𝑇 cos 𝛽𝑖 − sin 𝛽𝑖 eq.14.
𝑅 = . [5] eq. 5
sin 𝛽𝑖 cos 𝛽𝑖
Since the robot’s motion is planar, we also have:
7
International Journal of Computer Applications (0975 – 8887)
Volume 113 – No. 3, March 2015
cos (𝛽1 − 𝛾1 ) sin (𝛽1 − 𝛾1 ) 𝑙 1 sin (𝛽1 − 𝛾1 −𝛼 1 ) By replacing the parameters of Table 1 in matrix (eq. 15) and
𝑠𝑖𝑛 𝛾1 𝑠𝑖𝑛 𝛾1 𝑠𝑖𝑛 𝛾1 considering eq.14 we have come up with:
𝜔1 cos (𝛽2 − 𝛾2 ) sin (𝛽2 − 𝛾2 ) 𝑙 2 sin (𝛽2 − 𝛾2 −𝛼 2 ) 𝑣𝑋
𝜔2 −1 𝑠𝑖𝑛 𝛾2 𝑠𝑖𝑛 𝛾2 𝑠𝑖𝑛 𝛾2 1 −1 −(𝑙𝑥 + 𝑙𝑦 )
𝑣𝑌 .
𝜔3 = 𝑟 cos (𝛽3 − 𝛾3 ) sin (𝛽3 − 𝛾3 ) 𝑙 3 sin (𝛽3 − 𝛾3 −𝛼 3 )
1 1 (𝑙𝑥 + 𝑙𝑦 )
𝜔𝑧 1
𝜔4 𝑠𝑖𝑛 𝛾3 𝑠𝑖𝑛 𝛾3 𝑠𝑖𝑛 𝛾3 𝑇= , eq. 17
cos (𝛽4 − 𝛾4 ) sin (𝛽4 − 𝛾4 ) 𝑙 4 sin (𝛽4 − 𝛾4 −𝛼 4 )
𝑟 1 1 −(𝑙𝑥 + 𝑙𝑦 )
𝑠𝑖𝑛 𝛾4 𝑠𝑖𝑛 𝛾4 𝑠𝑖𝑛 𝛾4 1 −1 (𝑙𝑥 + 𝑙𝑦 )
eq.14
1 1 1 1
eq.15 shows the Jacobian matrix for the system’s inverse 𝑟 −1 1 1 −1
𝑇+ = 1 1 1 1 ; eq. 18
kinematic: 4
− −
(𝑙 𝑥 +𝑙 𝑦 ) (𝑙 𝑥 +𝑙 𝑦 ) (𝑙 𝑥 +𝑙 𝑦 ) (𝑙 𝑥 +𝑙 𝑦 )
cos (𝛽1 − 𝛾1 ) sin (𝛽1 − 𝛾1 ) 𝑙 1 sin (𝛽1 − 𝛾1 −𝛼 1 )
𝑠𝑖𝑛 𝛾1 𝑠𝑖𝑛 𝛾1 𝑠𝑖𝑛 𝛾1 According to equations (10) and (11) for Forward and Inverse
cos (𝛽2 − 𝛾2 ) sin (𝛽2 − 𝛾2 ) 𝑙 2 sin (𝛽2 − 𝛾2 −𝛼 2 ) kinematics there is:
−1 𝑠𝑖𝑛 𝛾2 𝑠𝑖𝑛 𝛾2 𝑠𝑖𝑛 𝛾2
𝑇= cos (𝛽3 − 𝛾3 ) sin (𝛽3 − 𝛾3 ) 𝑙 3 sin (𝛽3 − 𝛾3 −𝛼 3 )
. eq. 15 𝜔1 1 −1 −(𝑙𝑥 + 𝑙𝑦 )
𝑟
𝑣𝑥
𝑠𝑖𝑛 𝛾3 𝑠𝑖𝑛 𝛾3 𝑠𝑖𝑛 𝛾3 𝜔2 1 1 1 (𝑙𝑥 + 𝑙𝑦 )
𝑣𝑦 .
cos (𝛽4 − 𝛾4 ) sin (𝛽4 − 𝛾4 ) 𝑙 4 sin (𝛽4 − 𝛾4 −𝛼 4 ) 𝜔3 = 𝑟 1 1 −(𝑙𝑥 + 𝑙𝑦 ) 𝜔
eq. 19
𝑠𝑖𝑛 𝛾4 𝑠𝑖𝑛 𝛾4 𝑠𝑖𝑛 𝛾4 𝑧
𝜔4 1 −1 (𝑙𝑥 + 𝑙𝑦 )
And for the forward kinematic according to the eq.10, we
1
have: 𝜔1 = 𝑣𝑥 − 𝑣𝑦 − 𝑙𝑥 + 𝑙𝑦 𝜔 ,
𝑟
𝜔1 𝜔2 =
1
𝑣𝑥 + 𝑣𝑦 + 𝑙𝑥 + 𝑙𝑦 𝜔 ,
𝑣𝑋 𝑟
𝜔2 eq. 20
𝑣𝑌 = 𝑇 + eq. 16 𝜔3 =
1
𝑣𝑥 + 𝑣𝑦 − 𝑙𝑥 + 𝑙𝑦 𝜔 ,
𝜔3
𝜔𝑧 𝑟
𝜔4 1
𝜔4 = 𝑣𝑥 − 𝑣𝑦 + 𝑙𝑥 + 𝑙𝑦 𝜔 .
𝑟
2.1 The Relation between Motions and the And
Translation MATRIX 𝜔1
Analyzing the motion of a four Mecanum wheeled robot 𝑣𝑥 1 1 1 1
−1 1 1 −1 𝜔2
brings out the following conclusion: According to the inverse 𝑣𝑦 = 𝑟
4
−
1 1
−
1 1 𝜔3
kinematic, there is a relationship between velocities in each 𝜔𝑧 (𝑙 +𝑙 𝑥 𝑦) (𝑙 𝑥 +𝑙 𝑦 ) (𝑙 𝑥 +𝑙 𝑦 ) (𝑙 𝑥 +𝑙 𝑦 ) 𝜔4
joint and the robot’s center velocity, thus, the velocity of the
eq. 21
robot’s center is reflected by and obtained from an individual
wheels velocity. According to the robot kinematic, inverse Longitudinal Velocity:
kinematics can be achieved when the rank of the system is r
less than the rank of the Jacobian matrix for each wheel of the 𝑣𝑥 𝑡 = 𝜔1 + 𝜔2 + 𝜔3 + 𝜔4 . eq. 22
4
robot that reduces the degree of freedom of the robot’s joints.
Hence in a four Omni-differential design, the kinematic works Transversal Velocity:
with following conditions: r
𝑣𝑦 t = −𝜔1 + 𝜔2 + 𝜔3 − 𝜔4 . eq. 23
4
R Jacobian full column rank, i.e. if rank (R) = 3, the
Angular velocity:
robot performs a better movement.
𝑟
𝜔𝑧 𝑡 = −𝜔1 + 𝜔2 − 𝜔3 + 𝜔4 . eq. 24
The rank of the Jacobian matrix column 4 𝑙 𝑥 +𝑙 𝑦
dissatisfaction, i.e. if the rank (R) <3, the robot can
only move in a singular form and cannot achieve The resultant velocity and its direction in the stationery
all-directional movement. coordinate axis (x, y, z) can be achieved by the following
equations (eq. 25, 26):
3. FOUR MECANUM 𝑣𝑦
𝜌 = tan−1 , eq. 25
OMNIDIRECTIONAL SOLUTION 𝑣𝑥
8
International Journal of Computer Applications (0975 – 8887)
Volume 113 – No. 3, March 2015
backward
IJCATM : www.ijcaonline.org 9