Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
393-400, 1996
Copyright 1996 ElsevierScienceLtd
Printedin Great Britain. All rightsreserved
0967-0661196 $15.00 + 0.00
Pergamon
PII:S0967-0661(96)00017-2
1. INTRODUCTION
Intelligent vehicles will play a major role in future underwater missions, and the independent
and meaningful interpretation of sensor data is a
principal prerequisite for accomplishing high-level
autonomous underwater vehicle (AUV) missions
(Brutzmann et al., 1992). The interpretation of
sonar range data is specially important, as the
sonar is one of the most useful sensors for underwater geometric exploration. Much work has already been reported on sonar vision processing;
some examples could be found in (Brutzmann,
1994; Elfes, 1986; Leonard et al., 1992; Mandelbaum and Mintz, 1994; Mathisen, 1993; Matthies
and Elfes, 1988; Moran et al., 1993; Smith et al.,
1987). Most of the work is, however, done in
two dimensions, i.e. it addresses the construction
of 2D cross-sectional geometrical models or environment maps. For the purpose of environmental modelling by using line and arch primitives
(Mathisen, 1993), it is assumed that the objects
of interest have a constant cross-sectional geometry. This assumption is perhaps more suitable for
controllable scenes of man-made objects than for
a "real-world" operating AUV. The AUV's perception process must be able to cope with sonar
input describing arbitrary shapes.
A major part of the research in sonar-based modelling is concerned with building 2D-maps using
ultrasonic (and stereo vision) sensors operating in
air, i.e. the issue is obstacle avoidance and path
planning of mobile robots operating in "officelike" environments. With the operation of a six
degrees-of-freedom AUV in mind, some remarks
ought to be made:
1. The ultrasonic range transducers have different properties compared to marine sonars,
i.e. broader beam and shorter range. Sensor range with respect to vehicle size is not
comparable with the AUV case, which will
affect the objectives of sonar perception and
navigation.
2. Although well-known, the significantly different characteristics of sound propagation in
air compared to water should be pin-pointed.
Effects like signal damping, background noise
and temperature gradients (Ol'shevskii, 1978;
Urick, 1983) are not recognised by experiments in air. The conclusions drawn from
such experiments will be limited for the AUV-
case.
394
feasibility
tively organise
2. MOTIVATION
The main objective of the grid will be as a firstorder modelling process for AUV-relative navigation and world sensing. By this is meant how to
perform path planning and inspection, using sonar
ranging from the AUV's point of view. One actual
problem could be to plan navigation for getting a
better view of the object, possibly utilising other
sensors as well (for example using a video camera
at short ranges). Assuming the AUV to operate
in "exploration mode", the grid is a first-order
model of what the AUV senses from its current
position, integrated with what it has sensed
to this position. The 3D grid is therefore
AUV-centered.
its way
on
Sealevel
SOb
phi
Proje~tmnin
:~'::~:.:!!::"..:~:~!::::::i:~:'........
:":".::::::::_:~::.!!!!:~i;:'~!!!!::?"
Fig. 2. The 3D grid at the AUV's core for world perception.
Fig. 1. The AUV coordinate frame and the spherical
angles.
In this work the sonar is regarded as a range sensor with certain geometric and uncertainty features. More detailed modelling of underwater
echo-ranging requires complicated solutions of the
wave equation in a non-homogeneous medium,
which is outside the scope of this paper. The main
objectives here are range data organisation, uncertainty modelling and interpretation of stationary
objects for purposes like environmental mapping,
obstacle avoidance, and path planning. A spatial
framework for the exploitation and active use of
the 3D sonar range data is presented. An important aspect of this approach is the concept of ac-
more, a "modelling" process is suggested for extracting high-level geometric information, possibly also utilising object recognition by using an
object database. All these processes would run
in parallel and interact in a complex AUV expert
system, similar to the ideas mentioned in (Brutzmann et al., 1992).
y4-
395
. .~.
.~ 0
,+
" -t-
'-t%
.4.._~2
~ ............
..-b
--I-
396
(a) Spherical
(b) Rectangular
60 beams
150 degrees sector width
2.5 degrees beam spacing
Accuracy 0.3% of water depth (surface vessel
mounted sonar) or maximum 15cm. resolution.
In a spherical grid it is quite feasible to let cell geometry reflect these properties. For short ranges,
the radial cell size could be equal to the maximum
resolution, whereas further away from the AUV,
the radial cell size increases as a geometric series.
As such, the grid could be viewed as spherical
layers of increasing thickness. For a fixed maximal range, this approach will still give a fixed
number of cells in the radial direction. Simulations have indicated that such a grid is feasible,
even in a real-time perspective (grid update rate
keeps up with sensor data rate). When implementing this grid, only the theta and phi angles
(standard spherical coordinate definitions, refer to
Fig.l) need to be quantified into "buckets", allowing flexibility in the range parameter. It would
also be useful to be able to store grids with different resolutions, specially when searching for echo
clusters. This idea is similar to the scale-space
principle often used in image processing.
.>
I I '.'
I
RADIAl. CELL QUANTI HCAT1ON ~>
397
p((r,O)l(R,O)) =
2~rdRdO X
(1)
exp
This 2D polar Gaussian probability model expresses the probability of an echo at one point
(r, 0), given a sonar range reading at another one
(R,O), and assuming independent errors in radial and angular coordinates. The standard deviations (dR and dO) are given by the characteristics of the sonar sensor. Note that dR is a function of range, typically given as a percentage of
distance. For 3D simulation the model was used
to produce sonar-like echoes from cross-sections
at different z-coordinates. When mapping sonar
echoes to grid cells, the probability model in equation (1) is extended with another angular parameter of equal size (assuming conical beams). This
model is used to map sonar range readings into a
grid cell and update the state parameter. Initially,
a simple scheme using cell midpoints and maximal responses was implemented. More sophisticated algorithms have recently been investigated
using real sonar data as input, and specially the
inclusion of relative time between echoes allows a
more realistic modelling of cell states (Auran and
Malvig, 1996a).
398
-200
700
600
50O
+" 2
+'3
20O
x
Simulation and visualisation are useful and necessary tools for AUV design (Brutzmann, 1994).
At the Department of Engineering Cybernetics,
there has been a similar research project called
M O B A T E L (Balchen and Yin, 1994), which also
emphasises the use of powerful graphical workstations. Graphical visualisation is specially important when working in 3D. A visualisation tool has
been implemented, using Matlab to inspect the
output of different algorithms implemented in C.
This tool allows inspection from arbitrary viewing
directions, including zooming. The grid is presented as a 3D grey-level image, with the grey
level reflecting the cell state (darker cells represents more reliable echoes). An example of such
a 3D sonar image is given in Fig.6. Figure 6(a)
illustrates the 2D cross-section and the 3D path
within this virtual geometry. The indicated path
is constructed by adding a noisy sinusoidal movement in the z direction to a 2D path in the xyplane. The first ten "sonar scan locations" along
the path are enumerated. The second part of the
figure, Fig.6(b), is the resulting grid in position 10
as seen from above, keeping track of sonar scans
taken along the path. The four outer corner points
of each cell are also plotted, to make small cells
visible. The third picture, Fig.6(c), is a 3D view of
the same grid, illustrating its real structure. The
dotted lines are spaced 30 degrees apart in the xyplane centered at the current position. Note that
cell sizes vary with distance, in both radial and
angular directions.
30~
20~
100
-100
eg
-200
.300
-200
-100
100
200
300
W,~"
400
/ '
500
(b) 2D crossection
200,
150,
100,
50,
0,
East
-5D,
-100.
-150,
-200
200
4.3. Experiments
A specialised hardware circuit has recently been
designed to sample 3D echoes from a WesMar
SS150 sweep sonar. This is a mechanical sweep
sonar with a sound-cone of 6.5 6.5 and a frequency of 160kHz (WesMar, 1970). The sonar
is mounted on the research vessel "Balchazar",
a surface vessel belonging to the Department of
Engineering Cybernetics. The sonar b e a m d i r e c -
100
Y
x
(c) 3D grid
Fig. 6. Path in geometric model and resulting 3D grid
(in model coordinates).
399
31HI
270
2411'
ii
2
'30
120
~
Is0
90
I$0
8akhazar
&
S o n a r Scan
02O
330 . . . . . . . . . . . .
..... '
..-'"
16
..
.
. ....... ! .....
300 / "
"
,/'.
..
30
.,:.
12
. ""
"'".." . . . . . . .
"+
".
". 60
=.
-.
.'':
..,
"4
~
. ....;..
ve
24o .
..
:.
" .....
~.. ~.
-.
.,
210
: ...........
::
90
12o
...
.....
......
150
180
3,
2,
1,
~'o,
N-l,
-2,
-3,
5. CONCLUSION
A data structure for real time 3D sonar management has been presented. Experiments indicate
that the algorithms will keep up with a data rate
more than 60 times that of the WesMar SS150
sonar when implemented on a ordinary Sun Sparc
2 workstation (Auran and Malvig, 1996b). This
performance includes grid maintenance (registration, updating and transformation) and connected
components analysis. Hence, the 3D grid representation satisfy the real-time demands of a multi-
~
Y[ ]
~
-4
2
-3
-~
3 4
-
x[m]
400
beam sonar like the Simrad EM 1000 using lowcost hardware. It is a promising approach towards
autonomous underwater perception, and the research is continuing, with main focus on feature
extraction and object description from connected
3D echo clusters.
6. ACKNOWLEDGEMENTS
The authors wish to thank Donald P. Brutzmann, Naval Postgraduate School, USA and
Geir Mathisen, SINTEF Automatic Control, Norway, for their helpful support with information
and software regarding their research. This research was supported by NorFA (grant 94.30.150O) and the Research Council of Norway (grant
100626/410), greatly appreciated by the authors.
7. REFERENCES
Auran, P.G. and K. Malvig (1996a). 3D Sonar
Based Sensing for AUVs: Realtime Experiments within the Uncertainty Grid Framework.
Accepted for presentation at IFAC'96.
Auran, P.G. and K. Malvig (1996b). Realtime Extraction of Connected Components in 3D Sonar
Range Images. Submitted to CVPR'96 (IEEE
Computer Society Conference on Computer Vision ~ Pattern Recognition).
Bajcsy, R. (1988). Active perception. Proceedings
of the IEEE, 76 (8).
Balchen, J.G. and S. Yin (1994). The MOBATEL
Project - Model Based Teleoperation of an Underwater Vehicle Over a Narrow Band Communication Link. Technical report. The Norwegian
Institute of Technology.
Be~gem, O. (1993). Bathymetric Navigation of
Autonomous Underwater Vehicles using a
Multibeam Sonar and a Kalman Filter with
Relative Measurement Covariance Matrices.
Dr.scient thesis. University of Trondheim, Norway.
Blidberg, R., (ed.) (1987). Workshop Results
from the United States / France Cooperative
Program in Ocean Systems Technology: Autonomous Underwater Vehicles ~4 Underwater
Robotics.
Brutzmann, D.P. (1994). A Virtual World for an
Autonomous Underwater Vehicle. PhD thesis.
Naval Postgraduate School, USA.
Brutzmann,
D.P.,
M.A.
Compton
and Y. Kanayama (1992). Autonomous sonar
classification using expert systems. In: Proceedings of the IEEE Oceanic Engineering Society
OCEANS 92 Conference.
Durrant-Whyte, H.F. (1988). Sensor models
and multisensor integration. The International
Journal of Robotics Research, 7 (6).
Elfes, A. (1986). A Sonar-Based Mapping and
Navigation System. Autonomous Mobile Robots