scenario (non-structured, partially dynamic) will be,
for the rest of the document, the reference scenario in
which hypotheses and experiments have their validity.
Accordingly to the problem decomposition we
identified two main functional modules able to cope
with the given sub-problems. They are the Path Plan-
ner OFF-Line Module and the Path Planner ON-Line
Module.
2.1 Path Planner OFF-line Module
An important influence on the quality of the path
founded by the Path Planner OFF-Line Module, is the
quality of the graph that represents the free space. For
to represent the free space and for to build the cor-
responding graph we have studied the map building
techniques present in literature (Veeck and Burgard,
2004), (Masehian and Movafaghpour, 2009). All of
them use the information from the on-board sensors
of the robot. In the map building process it’s possible
to identify two main phases:
1. acquiring information through sensors about the
characteristics of environment and objects sur-
rounding the robot;
2. processing this information to obtain a summary
of the space around the robot, discarding the in-
consistent information due to the uncertainty and
imprecision of sensors.
There are many possible solutions to accomplish
these two steps and to get maps, but those the most
often and successfully used are based on grid maps,
on topological maps or on geometrical maps.
We developed a specific Geometric Map Build-
ing algorithm (GMB) capable of building, in a dy-
namically and incrementally approach, a geometric
map of the environment using sonar range or laser
scanner. The global map is composed of two main
type of contours, the first set of contours represents
the whole free space while the second set represents
the entire holes contours. We preferred the geomet-
ric map representation because we have a low mem-
ory occupancy, especially in situations where is very
broad. This choice is also useful because is better
to adapt representation of the points constituting the
map if necessary corrections due to errors caused by
the detection system of the robot, through its analyt-
ical operations of vector geometry. Starting from a
result of the dedicated map building module which
represents the 2D environment, a first goal was to ap-
ply a mesh algorithm to obtain a triangulation of free-
space.
Specifically, a standard 2D mesh geometry rep-
resentation is used for depicting an hypothetical en-
vironment map using as input the result of the map
building module. This is the potentially viable areas
by the robot. In general the term mesh refers to a set
of polygons such that two of its elements do not inter-
sect, or share a vertex, or an edge. Each polygon ap-
proximates a portion of the surface. Meshes are easy
to represent, to manipulate, to display and are also re-
constructed from irregularly sampled data. In particu-
lar we have chosen the triangular mesh, for which in-
ternal representation we stored geometric information
such as the position of the vertices of triangles, the
connectivity and the relationships between triangles
themselves. The used mesh algorithm can produce a
Constrained Delaunay Triangulation (CDT) (Delau-
nay, 1934): a construction of grids with finite trian-
gular element on plans domain filling generic forms.
The triangulation mesh algorithm is an exact decom-
position method of the free-space that produce a col-
lection of non-overlapping cells (triangles) and the
union of these, exactly equals the free-space or rather
the space in R2 where the robot can move without
colliding by static obstacles.
To get a free-path to move the robot from a start to
a goal is to keep it moving only over triangles that rep-
resent the free-space, or the part of the environment
completely devoid of obstacles (Lien et al., 2003). It
was thought to obtain a free-path as follows:
1. generate a basic Roadmap, always available in the
data structure, representing the undirected graph
G = (V , E ) where V is the set of all centroids of
the triangles forming the mesh in the free-space,
E is the set of all edges that connect each node V
with all adjacent nodes (minimum one and maxi-
mum three adjacent nodes for each triangle)
2. starting from a roadmap graph, a start point and
a goal point belonging to the free-space, on the
roadmap graph it is built, with Dijkstra algorithm,
a MST(Minimum Spanning Tree) or minimum
weight spanning tree. The graph is weighted by
the length of each edges of the graph. The MST
has as its root the centroid of the triangle closer to
the start point of the robot position.
3. if we denote by C
s
the centroid of the triangle in
the free-space closer to the start point and with C
g
the centroid of the triangle in the free-space closer
to the point of goals, we may define the Shortest-
Path (SP) as the path in the roadmap graph joining
C
s
and C
g
plus two edges, one that connects the
start with C
s
and one that connects C
g
with the
goal. This path represent a safety shortest path in a
free space that the Path Planner ON-Line Module
will use to planned a safe and smooth trajectory.
To ensure the MST covers the free-space really navi-
gable by the robot, a further prune operation is made
ICINCO 2011 - 8th International Conference on Informatics in Control, Automation and Robotics
418