Sie sind auf Seite 1von 4

Kinematic Modeling of a Six Wheeled Differential

Drive Intelligent Robot and Potential Field Method


to Attain Obstacle Avoidance Capability
Makhluk H. Prio and Fernando Rios
Department of Electrical and Computer Engineering
Georgia Southern University
Statesboro, GA, USA
mp07779@georgiasouthern.edu, frios@georgiasouthern.edu

Abstract—This paper presents the kinematic modeling of a six- workspace [3],[4]. Robot’s motion profile is generated before
wheeled differential-drive mobile robot on the basis of potential the robot has even moved in this technique.
field method to avoid obstacles.The position of the robot in the This paper represents a MATLAB Simulink kinematic
simulation is tested from an initial point to a final point in
presence of a rectangular shaped obstacle and obstacle avoidance model of a six wheeled differential drive autonomous naviga-
by the robot is observed. The entire kinematic modeling and tion robot with obstacle avoidance capability. Reactive control
testing are conducted using MATLAB Simulink. technique has been used due to its capability to deal with the
Index Terms—Differential drive, kinematic modeling, obstacle issues of real-time obstacle avoidance [4]. Among the many
avoidance, potential field, reactive control reactive control techniques described in the literature, potential
field method [4],[5] is implemented in this work due to its’
I. I NTRODUCTION simplicity[4] and time efficiency.
Immense development in the field of robotics brings forth The paper is organized as follows. The background on
intelligent enough mobile robots to autonomously perform kinematic modeling, potential field method, and assumptions
complicated tasks such as exploration in hazardous areas, res- we have for our work are described in section II.The con-
cuing injured people in disasters, distributing medicine inside struction of our robot is briefly interpreted in section III.
hospitals, providing physical security to critical infrastructures The MATLAB Simulink kinematic model for our robot is
in industries etc.[1]. Developing mobile robots is an arduous developed in section IV. Section V presents the simulation
and time consuming task. As most of the robotics projects results. Lastly, conclusion is included in section VI.
are time-consuming and costly to develop, it is very important II. BACKGROUND
to have a specific mobile robotic simulation model for the
purpose of research and development [2]. Designing an intelligent controller is a must to build an
Kinematics is study of the mathematics of motion without autonomous mobile robot capable of performing complicated
considering the forces that affect the motion. It describes the tasks [2]. An intelligent controller aids the robot to move
geometric relationships that govern the system as well as deals from one place to another while avoiding collision. One of the
with the control parameters and behavior of a system in state notable steps in order to design an controller is to understand
space. To attain better obstacle avoidance capability is a must the mechanical behavior of mobile robots, i.e, kinematics and
for a differential mobile robot to navigate properly. Under- dynamics of the system [6].Kinematic model is also helpful in
standing the kinematics of different mobile robots provide developing optimal use of energy when a robot is navigating
platform to design navigation controllers for them. They also and to develop a hybrid control system for navigating the robot
provide constraints on the motion of the robots which should A. Kinematic Modeling
be taken into consideration before doing any kind of navigation
planning [2]. Deriving a kinematic model for the whole robot’s motion
Reactive control and planning control are the two most is a bottom-up process. Each individual wheel contributes to
ubiquitously used navigation techniques. Reactive control is robot’s motion and, at the same time, imposes constraints
a low level control in which the robot navigates in the on robot’s motion. Wheels are tied together based on robot
environment while avoiding collision with real-time obstacles chassis geometry, and therefore their constraints combine to
using its sensors. On the other hand, the planning control form constraints on the overall motion of the robot’s chassis.
technique doesn’t utilize the real-time information from robot’s But the forces and constraints of each wheel must be expressed
with respect to a clear and consistent reference frame. This is
particularly important in mobile robotics because of its self-
978-1-7281-0137-8/19/$31.00 2019
c IEEE contained and mobile nature; a clear mapping between global

Authorized licensed use limited to: Universidad Militar Nueva Granada. Downloaded on October 31,2020 at 21:07:07 UTC from IEEE Xplore. Restrictions apply.
and local frames of reference is required [6]. Rotational speed B. Potential Field Method
of the motors attached to the wheels is the driving vector of Potential field method is one of many reactive control
a differential drive mobile robot. The robot performs various navigation techniques in which the mobile robot moving under
rotations and translations due to the difference in the speed of the influence of a potential field created as a result of attraction
the motors [2]. by the goal point and repulsion by the obstacles is represented
In the literature, a three wheeled differential drive robot with by a point in a configuration space[2],[8].
two rear drive wheels and a freely movable castor wheel in Considering that, the force applied by the goal on the robot
the front like Fig.1. was proposed [2],[7]. is Fatt and the force applied by the obstacle is Frep ,the
resultant force Fres on the robot is given by [2]

Fres = Fatt + Frep (7)


This resultant force is used to decide the direction of motion
for the robot and to calculate the rotational velocities of the
wheels of the robot [2]. In other words, it can be said that
resultant potential field is the summation of attractive potential
field by the goal on the robot and repelling potential field by
the obstacle on the robot.

C. Assumptions for Our Work


We assume both attractive potential field and repelling
potential field as included in the potential field method for
Fig. 1. The Generalized Mobile Robot: A Simplified Diagram our work.
1) Assumption made for the attractive potential field: We
In Fig.1,the axes X and Y define the arbitrary inertial base assume that goalpoint is a circle with a very small radius of
on the plane as a global frame of reference.The rear drive rg and the coordinates of the center of the goalpoint are xg
wheels have the same radius of r and they are separated and yg . If the position of the robot is (x,y), then the distance
a 2b distance apart from each other. The speed of the left is given by [2]
and right rear drive wheels are identified as ωL and ωR 
respectively. Speed of the DC motors and the wheels were d = (xg − x)2 + (yg − y)2 (8)
assumed identical [2].
The position of the robot in the global frame of reference The force by which the goal attracts the goal is determined
could be represented by vectors and is given by [2] by how fast the robot changes its coordinates towards the goal
⎛ ⎞ [2]. The faster the change of coordinates of the robot towards
x the goal, the stronger the force is.
ζ = ⎝y ⎠ (1) Considering the field has a spread of s, we have the
θ following three assumptions[2].
if d<rg , Δx = Δy = 0
Again, if θ is the heading of the robot, v is the linear
if rg ≤d≤s+r, Δx = α(d-rg )cosθ
velocity and ω is the rotational velocity of the robot, then,
the kinematics of the robot is defined by [2] if d>s+rg , Δx = αscosθ and Δy = αssinθ
The first assumption demonstrates the robot is not moving
when it is within circle of the goal and no force from the goal
x = vcosθ (2) acts upon the robot.
The second assumption implies that when the robot is
outside the circle of goal but inside the spread of the field,the
y = vsinθ (3) force by which the goal attracts the robot is proportional to
the distance between the goal and the robot.
The third assumption suggests that when the robot is outside
θ=ω (4)
the spread of the field, the force by which the goal attracts
The relationship between v and ω was described by [2] the robot will be maximum and it will be proportional to the
spread s of the field.
r(ωL + ωR ) Thus, the above three assumptions collectively depict, in
v= (5) attractive potential field, the coordinates will change faster if
2
the robot is far away from the goal or vice-versa. Also, the
r(ωR − ωL ) parameter α is always greater than 0 and it defines the strength
ω= (6) of the attractive potential field.The higher the value of α, the
2b

Authorized licensed use limited to: Universidad Militar Nueva Granada. Downloaded on October 31,2020 at 21:07:07 UTC from IEEE Xplore. Restrictions apply.
faster the robot moves towards the goal.The angle θg by which
the robot moves towards the goal is given by,
yg − y
θg = tan -1 ( ) (9)
xg − x
2) Assumption made for the repelling potential field: In this
subsection, it is assumed that the obstacle is enclosed by an
imaginary circle of radius r0 . This circle works as a barrier
for the robot which it can’t cross. Whenever the robot comes
closer to this imaginary circle barrier, it only gets repelled.
Considering that, the co-ordinates of the center of the
obstacle are x0 and y0 . If the position of the robot is (x,y),
then the distance (d) between the obstacle and robot is given
by[2], Fig. 2. Robot Used for Our Work


d= (x0 − x)2 + (y0 − y)2 (10) Step 1: The first step to start the kinematic modeling in
Again, considering the field has a spread of s, we have the MATLAB Simulink is to measure different parameters of
following two assumptions [2]. motor which are responsible for energy losses. The measured
if d<r0 , Δx = -βdcosθ and Δy = -βdsinθ parameters of motor are armature resistance, armature induc-
if d>r0 , Δx = Δy = 0 tance, armature capacitance, moment of inertia, and angular
velocity.
The first assumption implies that inside the circle of ob-
The armature resistance is measured by doing a locked rotor
stacle, the repelling force by the obstacle on the robot is
test. Following equation [2] is used to measure the armature
proportional to β and it points out from the center of the
resistance by keeping the back emf constant, Kb equal to zero.
obstacle. Repelling force determines how fast the robot moves
away from the obstacle. β, is used to determine the strength
of repelling field, and will always be greater than 0. V = Ra I a + K b ω (13)
The second assumption suggests that outside the circle of where V is the terminal voltage, Ra and Ia are the armature
obstacle, no repelling force on the robot by the obstacle resistance and armature current respectively, Kb is the back
sustains, i.e., no repelling force is applied on the robot by the emf constant, and ω is the angular velocity of the motor.
obstacle if the robot is away from the vicinity of the obstacle. Afterwards, armature inductance and armature capacitance
3) Assumption made for the resultant potential field: It is are measured using a LCR meter.
assumed that the sum of attractive potential field and repelling Step 2: The next step in the process is use the measured
potential field give the resultant potential field. The resultant parameters in step 1 to obtain the output of the plant which
field brings forth the linear velocity, v and the direction of is the x, y and θ.The modeling of the plant is completed by
motion,θ of the robot. These are given by the following this step.
formulas [2]. Step 3: Finally, MATLAB Function block is used to es-
 tablish the assumptions we made in Section II , part C and
v = (x0 + xg )2 + (y0 + yg )2 (11) potential field method is implemented successfully to avoid
the obstacles .The outputs of this MATLAB function block are
y0 + yg
θ = tan -1 ( ) (12) linear velocity, v and the direction of motion of the robot,θ.
x0 + xg
V. S IMULATION R ESULTS
III. C ONSTRUCTION OF O UR ROBOT
Fig.3 presents the complete kinematic model of the
We pick a six wheeled mobile robot for our work in order robot.The input to the model is the position of the goal. It
to get better traction on different surfaces. The robot follows shows the response on the robot’s position when a rectangu-
differential drive mechanism with three wheels on each side of lar shaped obstacle is inserted into the kinematic model as
the robot’s body. DC motors and motor controller are mounted input.The result of the obstacle avoidance is shown in Fig.4.
underneath the robot base, while batteries and microcontroller
are mounted on the robot base. Fig. 2 shows the setup of our VI. C ONCLUSION
robot. Kinematic modeling of a six wheeled differential drive
intelligent robot based on potential field method has been
IV. MATLAB S IMULINK K INEMATIC M ODEL FOR O UR presented. A smooth trajectory is achieved for the robot
ROBOT from the kinematic modeling to avoid obstacles. The obstacle
To develop kinematic model for our robot, the following avoidance capability of the robot is observed in presence of a
steps are followed. rectangular shaped obstacle.

Authorized licensed use limited to: Universidad Militar Nueva Granada. Downloaded on October 31,2020 at 21:07:07 UTC from IEEE Xplore. Restrictions apply.
Fig. 3. Kinematic Modeling of the Robot for Avoiding a Rectangular Shaped Obstacle

[5] O. Khatib, ”Real-time Obstacle Avoidance for Manipulators and Mobile


Robots,” Proceeding of IEEE International Conference on Robotics and
Automation,1985, pp.500-505.
[6] R.Siegwart and I.R.Nourbakhsh,Introduction to Autonomous Mobile
Robot, London, The MIT Press, 2004.
[7] C.H. Kim and B.K. Kim, ”Minimum-Energy Translational Trajectory
Generation for Differential-Driven Wheeled Mobile Robot,” Journal of
Intelligent and Robotic Systems, vol.49, pp. 367-383, 2007.
[8] L.Yin,Y.Yin, and C.-J.Lin, “A New Potential Field Method for Mobile
Robot Path Planning in the Dynamic Environments,”Asian Journal of
Control, vol.11, no.2, pp. 214 – 225, 2009.

Fig. 4. Robot Avoiding a Rectangular Shaped Obstacle

R EFERENCES

[1] M.Wahab, F.R.-Gutierrez, and A.E. Shahat,” Energy Modeling of Dif-


ferential Drive Motors,” Proceedings of IEEE SoutheastCon, 2015, pp.
1-6.
[2] M.Wahab and F.R.-Gutierrez,”Modeling Kinematics of a Differential
Drive Robot to Develop Obstacle Avoidance Capability using Reac-
tive Navigation Control Techniques,” IEEE Dallas Circuit and System
Conference, Oct 2014.
[3] V.J.G.Villela, R.Parkin, M.L. Parra, J.M.D, Gonzalez, M.J.G. Liho, ”A
wheeled mobile robot with obstacle avoidance capability,” Journal of
Ingenierı́a Mecánica Tecnologı́a y Desarrollo, vol.1, no.5, pp.159-166,
2004.
[4] D.F.-Guang,J. Peng, B. X.-Qian, W.H.-Jian, ”AUV local path planning
based on virtual potential field,” Proceedings of IEEE International
Conference on Mechatronics and Automation, 2005, pp.1711-1716.

Authorized licensed use limited to: Universidad Militar Nueva Granada. Downloaded on October 31,2020 at 21:07:07 UTC from IEEE Xplore. Restrictions apply.

Das könnte Ihnen auch gefallen