observation
distribution of obstacle
Figure 1: Result of update when the robot gets the observa-
tion of the obstacle of substantial margin of error.
(Rachlin et al., 2005), its computational cost is huge,
especially in case of high grid resolution. Previous
methods (Miura et al., 2002; Thrun, 2002a; Moravec,
1988) use the following assumptions for reduction of
computation:
1. Observation obtained for each map grid is prob-
abilistically independent (it depends on only the
state (obstacle existence) of that grid).
2. Obstacle existence of each map grid is indepen-
dent to each other.
Most obstacle sensors observe the most frontal ob-
jects and any objects behind them are occluded. Since
such sensors having sensor occlusion characteristic
does not satisfy the above assumption 1, the follow-
ing serious problems are caused by forcedly using the
assumption.
As shown in the left side picture of Figure 1, sup-
pose that dark grey ellipsoidal region has higher prob-
ability of obstacle existence than the outside. Then
suppose that the obstacle observation with large error
(ex. distant observation with stereo vision) is obtained
shown as the light grey region in the figure. In that
situation, that observation probably comes from the
most frontal part of the dark grey region. The assump-
tion 1, however, the obstacle existence probability of
each map grid is independently updated by integrat-
ing the observation and it is obviously overestimated.
As a result everywhere distant from the current robot
position tends to be estimated as obstacle in the map.
Therefore the assumption 1 should be rejected.
In addition, the assumption 2 also leads to the
other problems. If the obstacle existence in each map
grid is independent, the probability of that a certain
area is open as free-space is estimated as the product
of the probability of each map grid. This leads to an
obviously irrational result that more precise grid reso-
lution is adopted, abruptly smaller becomes the free-
space probability of the same area (in other words,
the viewing field is more invisible due to occluding
obstacles).
In real scenes, obstacles and free-spaces has a
certain size. This points out the existence of co-
occurrence between the adjacent grids, called spatial
continuity. Since the co-occurrence becomes larger
when the grid resolution is more precise, the free-
space probability can be correctly estimated regard-
less of the grid resolution. Thus the assumption 2 also
should be rejected.
Our map building method correctly considers sen-
sor occlusion and spatial continuity. A certain ob-
stacle is visible if and only if the space between the
sensor and the obstacle is entirely open as free-space.
Therefore we introduce a novel method of estimating
visibility of the obstacle on each map grid by consid-
ering spatial continuity, and updating the obstacle ex-
istence probability with proper consideration of sen-
sor occlusion.
2 MAP BUILDING
CONSIDERING SENSOR
VISIBILITY
2.1 Joint Probability of Adjacent Grids
on Each Viewing Ray
We first divide the map grids into multiple viewing
rays. The sensor observes the existence of obstacle
on each ray. In this paper, we represent the viewing
ray as the 4-connected digital line as shown in Fig-
ure 2. On each ray we consider the probabilistic grid
state (whether obstacle exists on the grid or not) as
a simple Markov chain. Thus each grid state can be
represented as the joint probability of two grid states
adjacent on each ray.
Figure 2: Approximated Lines of view.
We first estimate the joint probability of the jth
and j + 1th grid (the jth grid is nearer to the sensor)
on a viewing ray (see Figure 2). Let e
l
j
=
n
E
l
j
,
¯
E
l
j
o
be
the state of the jth grid on the lth ray (E:occupied by
an obstacle,
¯
E: not occupied), and P(e
l
j
, e
l
j+1
|O) be
the joint probability of the jth and j+ 1th grid under
O, the series of the previous observations. Then the
joint probability after the latest observation o obtained
PROBABILISTIC MAP BUILDING CONSIDERING SENSOR VISIBILITY
201