Professional Documents
Culture Documents
IFAC
PUBLICATIONS
www.elsevier.comllocatelifac
Abstract: This paper presents the mech an ical design process of two wheeled mobile
robots. Each step of the final design process in two cases is described . Case I is related to
the omni-directional mobile robot and case II is a differential drive robot. In addition , the
kinematics equations of the final design are derived and their inverse .Iacobian matrix for
the designs are presented. The dynamic equations of motion for the final design are
derived in a symbolic form, assuming that no slip occurs on the wheels in the spin
direction. In order to validate the kinematics and dynamic equations, consequences of
s imulation in Maple and Visual Nastran softwa res are carried out. Finally, by using
kinematics equations and UMBmark test errors of an omni-directional robot and
differential drive robot are determined and corrected by applying correction factors.
Copyright © 2004 IFAC
629
the accuracy of the data obtained ti'om experimental 1.1. Case 11. DijiCrential Dril'e Robut
test of robots. The construction of differential drive robot is consist
of some components such as two light wheels. two
pulley-belt systems. two shafts that connect the
2. DESING OF MOBILE ROBOTS wheels to pulleys. a micro controller and a processo r
for data processing transmitted to the robot as shown
There were several factors influencing the design of in Fig. 3.
mobi le robot such as : weight of robot, type and Two empowered castor wheels provide the
material of wheels and rollers and control devices. equilibrium of system at the ends of the robot. The
The mechanical design process starts by knowing the castors cause slipping during direction changes. The
robot parts and environment. drive has the advantages of simplicity and a very
tight turning radius.
:!. I. Cuse I: OIl//1I-Directi onal Robot The motors are coupled to the wheel shafts through a
A computer controller consists of three drivers with 50.1: I gear ratio. Two stepping 1110tors are controlled
its own DC motor is used as shown in Fig. I. Three by a Penti um III computer. The data are sent as
DC motors with built-in reduction gears and pulses through LPT I port for each motor. These parts
incremental encoders drive three wheels constituting are shown in manufactured model of robot in Fig. 3.
the front axle of the vehicle. The mechanical
mechani sm consists of three gear boxes, three belt-
pulley system s and six shafts for transmitting the
angular velocities of gear boxes to the wheel s. The
angle between the motor shaft and the wheel shaft is
<)() degrees. No change in angular velocity is
observed in the belt-pulley system and torque is
tran smitted to the wheel. The gearbox is located
between the upper shaft and motor shaft.
t..Y ''______
Fi g. 3. Manufa ctured differential cirive robot
3. KINEMATICS MODELl NG
630
Where R refers to the distance from the centre of
gravity of the robot to the centre of the wheels along
a radial path . [X" )~,] is the fixed world frame, ~ is
.J=~[COS(8+~) - sin(8+'1i) -I] (8)
the orientation of the robot with respect to the fixed
I' COS(s -'1i) - sin(8 -'1i) - I
Fig. 4. Kinematics diagram of mobile robot coefficient. I, can be obtained frOI11 constraint
equations (5) to (7) and A, from equation of moti on.
e quation (3) allows us to form the inverse Jacobian
matrix of the system as follows:
-I. I. Cose r Oll/l7i- Directiol7al Robot
[
S ill(IiI+ ~+Y) COS(O , +4>+y) Ij COSY] (4)
.r' = _ 1- sill(o: + ~+y) cos(o , +~+y) Ij COSY
Ncos y .
s lIl (8 , + ~+y) cos(8 , +~+y) I',COSY
Substituting the kinetic and potential term s into
equations (9) derives the equations of motion in the
Where y angle for thi s design is taken zero and standard format. The torques are influenced from the
shows the structure of wheel s. effect of potential and energy terllls and calculated
either so lving these equations using Maple software
3. I. DifFerential f)rive Robots (Korayelll, Maddahi, Bani Rostam,
Figure 5 shows the inertial coordinate system for a 2004).
differential drive mobile robot. The inertial
coordinates of the robot are given by (x, y{. The -1.2. Case //.. Differential Drive Mobile Robot
angle that the velocity vector makes with the inel1ial
Consider the differential drive mobile robot shown in
.raxis is given bye . (i) /( and (i) I. that are related to
Figure 3. 't I is the torque exerted on the robot by
the angular velocity of robot wheels. To get the robot
position and orientation, the velocity constraints right wheel. l' 2 is the torque exerted on the robot by
should sati sfY the following non-holonomic the left wheel and I is the distance frolll the centre of
con straint : mass to the wheels and is equal to -T I that the
1'0) , -\-cos(8 +~ )+ j'sin(8 +~ )+/o) =0 (5)
positive is relative to't I and negative expressed 1:' 2 .
,.0)/1 -'/i) + ysin(8 -'/i) +/0) = 0 (6)
- .i'cos(S The torques of actuator is cal cul ated by solving the
dynamic equations. As shown in equations (10) the
.-I-cos(8 +~) + ) ' sin(e + '/i) = 0 (7) torque of right \-"heel has a small di fference with the
1f torque of right wheel.
•. i'
y ./ /.~/ T= ~r (M + 3111 )eo,S + -':' 1'(,1/ + 3111 )sinS
2 2 (10)
". ~,.",, \-;,,:;1~
t:i • '~-' ~. (I.. 'I
Er ~+ .'111 +-II1
± -r I (".,r· +h'' ))
Ir-r---->.,;,'-/--:/~Z!f 2 I 61
631
bJse (0") are presented. Thi s simulation deals only 5.2. Case II. Differential Drive robot
with mechani ca l factors and ignores any electrical The responses of the robot to the same input with
components and slippage. difference direction for orientation with maintaining
a fi xed position of base are presented. The additional
objects such as motors are not shown in this mode l.
Fig. 10 presents the schemat ic mode l of analyzed
-M_ vehicle. The overshoot is approx imatel y 4.52% for
the X position and 0.8% for the Y position as can be
seen from Fig. I L In Fig. 12 the to rques of motor I
are shown. As show n the predicted torques in
Working Model has some difference with theatri ca l
condit ion. The source of these errors is that in
theoretical models the friction is negligible but in
Working Model and manufactured plans the fri cti on
plays an essential role. In thi s model the coefficient
of friction is considered too large therefore the
Fig. 6. Compari son between the positions in two Fig. 1'2 have jumps with high amplitude.
si lllul ati ons
---Map le
" .... 1 - - - -. - -
.. u
Fig. 10. The schematic model of differentiJI drive
Fig. 7. Co mpar ison of torque in Illotor I robot
.-- 1
.,
r
.1
·''' .. ·· 1..-·1
Fig. 11 . Comparison between the positi ons in two
Fig. 8. Compari son of torque in motor '2 si mulati ons
-I
,,,I -----. _.. _ - - - - --
,I --_._---
632
are joined to a common axle, the posItIon and nominal wheelbase of the vehicle (Borenstein,
orientation of the centre of the axle relative to the Everett, and Feng, 1998).
previolls position and orientation can be determined
from odometry measurements on all of wheels. In 6.2.2. !v/easlIrement and correction o(systematic
practice. incremental encoders are mounted onto odomet,y
three drive wheels.
One of the methods for measuring odometry errors is
61 . C({se I: Oml1i-directional Mobile Robot UMBmark test. In this test robot is programmed to
traverse the four legs of a square path in C. W. and
III this paper a simple method was selected to test an c.c. W. directions but because of some errors not
ollllli-directional mobile robot. The robot is moved in precisely return to the starting position (Borenstein,
special trajectories such as straight or self-rotational and Feng, 1996). Simulation of a differential drive
paths. In this Section the results of test are shown in robot with effect of two different odometry errors in
Figure 13. The test was carried out ten times for motion of robot is shown in Figs. 14 and 15.
every trajectory.
7: " . ~ ,·!l
In Figure 13 the robot is rotated around its central ,, ~. ,:. ' ;
fo!:ilChFd
,E bano
Sqll ,H~
err~:~
l con<'ee' ,
otner
Palh
:.
~
":}
l' ,,'
')
10 2ll 30 10 m 60 ! 0 !Il 90 100 110 120 1
-10
x(Cml
Fig. 13 . The robot rotates along its central axis The UM 3 matk l e'sl
Two o doffl€:fry Nrors
(C.W.)
1[ b a nd £: d) ampl i ~y
e.] ch oUwr
Square P,,)lh
6] LJifjerential Drive r:.',
'V
imperfections In the design and mechanical Fig. 15. Simulation ofUMBmark in C.W direction
implementation of a mobile robot and caused by
resources that some of them are listed in below. Upon completion of the square path in each direction
a. Unequal wheel diameters absolute position of the vehicle is measured. These
b. Average of both wheel diameters differs from absolute measurements are then compared to the
nominal diameter position and orientation of the vehicle as computed
c. Misalignment of wheels from odometry data.
d. Uncertainty about the effective wheelbase (due to The amount of erroneous rotation in each nominal 90
non-point wheel contact with the floor) turn is denoted as a in radian.
e. Limited encoder resolution Because of the ratio between wheel diameters robot
f. Limited encoder sampling rate moved on curved path instead of straight path. The
Lac k of exact method for measurement amount of robot will have gained an incremental orientation
odometry errors cause mobile robot calibration error p ,at the end of each straight leg in curved
doesn ' t have enough accuracy. Error categorizations
are used for measurement odometry systematic error. motion cases.
• Unequal wheel diameters. a. and p can be found from simple geometric
relations.
E =~ (11) (Xc,g-,cw-Xc,g-,ccw) 180
" D, a = '. , x-- ( 13)
-4L IT
• Uncertainty about the wheel base.
h ( 12)
p = (Yc,g,cw+ Yc,g.ccw) x 180 ( 14)
r ·. = ~
~., h ll" llIrnal -4L IT
Where XC , {!,cw / CCH' and Yc,g,cw / cclI' are tow
\Vhere Du, D, are the actual right and left wheel
centre of gravity and L is straight leg of the square
diameters and bu c lllu " b'''''"ill ,,/ are the actual and path.
633
Using simple geometric relations, the radius of REFRENCES
curvature R can be found as:
V_ (I)') Chong. S.K and Kleeman, L. (1998). Accurate
1(= _-_2_
sin(p / 2)
Odometry and Error Modeling for a Mobile
Robot.
Then . we have.
Wit, C. C. (1998). Trends in mobile robot and
R+ -
D 'I -
Ed = - >i (16)
vehicle control. Control Problems in Robotics
andAutomation,pp.ISI - 17S .
D, R - ~~ Choi , B. J. and Sreenivasan, S. V. (1999). Gross
motion characteristics of articulated mobile
Similarly. we can compute the wheel base error Eh'
robots with pure rolling capability on smooth
90 " uneven surfaces. IEEE Trans. Robot. Automat..
h =- - -a
-h ( 17)
, 1,"/1 1111 90() /lflf1l1J wl
vol. IS , pp. 340-343.
So that two correction factors defined as (Borerstion Hamdy , A. and Badreddin, E. (1999). Dynamic
and Feng, 1(96): modeling of a wheeled mobile robot for
2 identification, navigation and control. in Proc .
CI ( 18) IMACS Conf. Modeling and Control of
E" +1 Technol. Sy st.. pp . 119-128 .
2 Scheding, S. Dissanayake, G. Nebot, E. M. and
er I
( 19)
Durrant-Whyte, H. (1999) . Experiment in
-- +1 autonomous navigation of an underground
E mining vehicle. IEEE Trans . Robot. Automat.,
"
Fig. 16 shows experimental results of this method in vo!. 15 , pp. 8S-9S.
C. W. and c.c. W. directions before and after Dickerson, S. L. and Lapin, B. D (1991 ). Control of
calibration. an omni-directional robotic vehicle with
mecanum wheels. in Proc . Nat. Telesystems
....
\ .\
.- ...... -•.... -... -_ .. -................ ~-.
_ONEIot..,.c.lI'*'"
• COVIW.,C.... IItIoII .
Conf., Vol. I, pp. 323- 328 .
Marchler, Ph (1997). Robot Odometry Correction
. 'IJJNA""~
634