An Ultrasonic Collision Detection System
An Ultrasonic Collision Detection System
Keywords: Robot; Sensors; Collision detection; Ultra- Fig. 1. Unmanned robotic cell at Auburn University (Shaded
sonics machines to be added).
1. A stocking crate is left in front of the band saw (2) decide whether the robot is in danger of colliding
and is also in the robot's path. The robot moves to with the object, and (3) stop the robot if a collision is
retrieve a part from the band saw and crashes into imminent.
the crate. Noncontact range finders can measure the distance
2. A fixture or jig breaks, causing the part's location to an object. Koenigsberg [7] grouped noncontact
to deviate from the robot's preprogrammed pickup range finders into three categories based on their
point. The robot fails to retrieve the part from the operation modes: mechanical, electromechanical and
band saw. electromagnetic. Mechanical noncontact distance sen-
3. A decrease in pressure to the robot's pneumatic sors include pneumatic and acoustic sensors. An
gripper prevents the robot from grasping the part example of pneumatic sensor is a fixed nozzle through
on the band saw. which air escapes. As an object is brought into the
airstream, an increase in pressure upstream from the
In most robotic-centred cells, an important sensing orifice is developed and can be sensed by a simple
requirement is to detect obstacles in the robot's path. pressure transducer. This method is practical for
To avoid obstacles by generating alternative trajectories ranging distances of less than 1 cm and thus is not
or paths around the obstacle may also be important, useful for collision detection that requires 0.1-10 m
particularly for mobile robots. ranging distances.
Collision detection and collision avoidance methods Acoustic sensors such as sonar and ultrasound use
prevent collisions between a robot and an obstacle. sound waves. Ultrasonic transducers have distinct
The collision avoidance method - a computationally advantages as ranging devices in collision detection.
intensive problem in real-time robot control [4-6] - These compact, lightweight sensors can be mounted
determines a collision-free path for a robot moving to a robot wrist without impairing the arm's function.
among a set of obstacles. Existing collision avoidance US Patent 4 636 996 [8] describes a mobile robot that
schemes can handle only a limited range of predefined has an array of ultrasonic transducers for detecting
obstacle shapes and robot motions. objects. Working on robot collision detection, Marsh
In the collision detection method - a much simpler et al. [9] also combined information from several
problem - if an obstacle is sensed, the robot stops. In ultrasonic transducers with a priori information to
collision avoidance systems, collision detection sensors generate three-dimensional images of simple objects.
determine the presence or absence of an object in the Ultrasonic sensors are also used in navigation,
robot's operating path. positioning, imaging and simple distance measuring
Collision detection is important for several reasons [10-12]. Guichard and Renault [13] describe an ultra-
[7]: sonic ranging sensor application for adapting a robot's
1. An automatic collision detection system can prevent path to compensate for the position variations of car
a robot from crashing into an obstacle, particularly bodies moving on an assembly line as the robot sprays
when the robot is programmed off-line without them with sealant.
thorough knowledge of the cell environment. An ultrasonic ranging module developed by Polaroid
Corporation for automatic camera focusing has simpli-
2. A collision detection system can protect expensive fied and lowered the cost of noncontact distance
machine tools and devices in a manufacturing measurement [14]. On a mobile sentry robot, a ranging
environment. system designed for navigation by the US Naval Ocean
3. From the collision detection system data, a model Systems Center in San Diego, California, used the
or world map of the work cell can be built for Polaroid ultrasonic transducer with a ranging module
use in graphic simulation, collision avoidance and made by Texas Instruments (TI) [6]. This ranging
facilities layout. system had an array of five sensors for distance
The purpose of this project was to design and build measurement. It shows promise for further sensing
a collision detection system, based on an inexpensive applications in manufacturing and related industries.
ultrasonic sensor, for an A S E A IRB 90/2 robot in Electromechanical sensors, including linear and
a cellular manufacturing environment. This article rotary variable displacement transducers and magneto-
describes the hardware, control software and detailed acoustic sensors, restrict distance measurement to a
operation of the system. It also describes the testing fixed linear or rotary axis [7]. Electromagnetic sensors
and verification of the system as a function of the include optical, magnetic, capacitive, radio propagation
robot's speed and types of motion and load. and nuclear radiation sensors. Optical sensing,
especially machine vision, is a popular research area
and may be the preferred method in the future. A
basic vision system gives two-dimensional information
2. Literature Review about a scene. This information is useful in pattern
recognition and planar object location algorithms,
Collision detection systems for robots must perform but in most material-handling robot tasks, distance
three functions: (1) measure the distance to an object, information is more important [15]. Although stereo
An Uhrasonic Collision Detection System 95
IO IBMAT
I/O INTERFACE I
BOARDUSING
INTEL8255
INPUTSOUTPUTS
I IT Ilh
-
~ ASEAROBOT 1 I |
CONTROLLER T 0Vl 12"v
RANGN
IG
MOOUL#2
E
[ vos~,. I"1 I I'['1
INPUT~
vision can be used to measure distance, machine vision Personal Computer A T (IBM AT). Figure 2 is an
systems are expensive and image analysis algorithms electrical schematic of the complete system.
are complex; therefore, other noncontact ranging
methods are more economical.
The objective of this research was to develop and 3.1 Hardware Description
test an ultrasonic collision detection system for an
A S E A IRB 90/2 robot. Work has been done in
interfacing ultrasonic transducers to robots, but little The sensor portion of the collision detection system
work has been reported on using an ultrasonic collision consists of two Polaroid ultrasonic transducers and two
detection system in a manufacturing cell. In addition, corresponding TI ranging modules. The transducers
this research sought to determine the effect of robot are mounted to an aluminium plate attached to the
motion, load and speed on the stopping distance for robot wrist mounting plate (Fig. 3). The ranging
the robot under the ultrasonic collision detection modules are mounted close to the transducers on the
system's control. robot wrist to minimise power loss to the transducers.
The ranging modules have two operation modes:
single-echo and multiple-echo [14]. The multiple-echo
-- ~ Fig- 5 (1) ( ~
Dectare code, data I M~n Program Push conlents ol r
1
Fig. 5 (2) Output a character
SUlck segrne~ts I ir~s~ctions or~ s~ac~ SERVICE Subrouline it: the keybd buffer
I I I
O e C ~ ve~ab~esand Read flag Print "Object delec~ed!"
sel TMR_CNT1, TMR_CNT2
I
r
Reset IC 8254 to
I
Call ROBOT subroutine
Ca~ default intBrPJpt
I rate _lI
Fig. 5. Flowchart of assembly language control program for the ultrasonic collision detection system: (a) Main Program;
(b) SERVICE subroutine; (c) ROBOT subroutine.
the time the INIT line is held at a logic 0 and logic 1 For maximum reflection, one face of the prism was
state, respectively. The main program then monitors placed perpendicular to the path of the ultrasonic
the keyboard for a key strike, enabling the user to signals in the horizontal and vertical planes.
exit the program gracefully, and enters a loop in which The collision detection system was tested with the
the S E R V I C E subroutine is called. A S E A robot for two robot paths and two end
The S E R V I C E subroutine controls the ranging effector loads. In one robot path, the robot arm was
modules by setting the INIT lines to either a logic 0 programmed to swing about the base - referred to as
or 1 state, depending on the flag variable's value and swinging motion (S). In the other robot path, the robot
the status of the E C H O lines. If an echo was not end effector was programmed to move radially from
detected in the time identified by T M R _ C N T 2 , then the base - referred to as linear motion (L).
no object was detected in the user-defined distance For all tests, the robot end effector was a two-jaw
and the control loops to the main program. pneumatic gripper. The transducer was mounted on
The R O B O T subroutine is called when an echo is the wrist mounting plate, 480 mm from the tips of the
detected. This subroutine simply prints a message on gripper jaws. The ranging distances set in the assembly
the console and ends the program. It could also send control program were reported as the distance from
a signal to a cell host computer, activate an alarm, or the tips of the gripper jaws to the object. The ranging
initiate a collision avoidance scheme. modules' total ranging distance was the 480 mm
transducer-to-gripper distance plus the gripper-to-
object distance. The programmed ranging distance was
4. Experimental Procedure 239 mm beyond the gripper tips. The robot end
effector's starting position was outside the programmed
The objective of the experimental tests was to verify ranging distance, and its programmed final position
the collision detection system's operation and to was beyond the obstacle. Programmed point-to-point
evaluate its performance as a function of programmed robot speeds were 50 to 700 mm/s.
robot speed. The robot was programmed in the A S E A The two loads were 0 and 16.8 kg. Therefore, four
robot language ( A R L A ) to move toward an obstacle different treatments, each consisting of five replications,
using a rectangular, wrist-oriented coordinate system. were analysed. The treatment label abbreviations rep-
That is, the robot end effector moved using straight resent the load and the robot motion; for example, 16L
line motion between programmed points [21]. The represents a 16.8 kg load and a linear motion.
obstacle was a 4 ram-thick cardboard triangular prism.
98 L. K. Kutz et al.
300,
in each case at e~ = 0.001 or smaller. All four regression
-4 2
Y = 227.3 - 0,4032X+ 1.352 x 10 X
models correlated well with the data; the correlation
R2= 0.9835 coefficients were 0.98 or better for each model.
E Further statistical analyses were done using the
E
G L M homogeneity-of-slopes model to evaluate the
6 hypothesis that the treatments had no effect on
0e- 200
stopping distance. Analysis of covariance revealed that
treatments 0S and 16S were not significantly different
C3 at o~ = 0.05. However, treatments 0L and 16L
were different from each other and were individually
.E loo different from treatments 0S and 16S. Figure 7 shows
D..
Q. plots of the four regression models as three separate
O
zx groups. Therefore, the type of motion has a significant
effect, as expected, because the robot's dynamics are
different for the robot swinging about the base than
0 200 400 600 800 for the robot arm moving radially from the base. The
load also affected the robot's stopping distance,
Robot Speed, mm/s supporting the hypothesis that the robot's increased
momentum at faster robot speeds also decreased the
Fig. 6. Robot stopping distance (Y) versus robot speed (X) for final measured distance between the gripper tips and
treatment OL (0 kg load, linear motion). the object.
5. Analysis of Results
robot speed. The stopping distance is the final measured OS " ' - ~ \ % \ ,...
.c_ 100
distance between the gripper tips and the object. The ~.
regression line was obtained by analysis of variance e~
0 16S " < ' ~ . .
using the SAS generalised linear model (GLM) pro-
cedure [22]. A quadratic model was fitted to the data
for each of the four treatments. Quadratic models for 0 r I I I I / =
all four treatments are displayed in Table 1. 0 200 400 600 800
Analysis of variance on each of the regression Robot Speed, mm/s
coefficients for each of the four models showed that
Fig. 7. Combined plot of robot stopping distance (Y) versus robot
the linear term was significant at e~ = 0.0001. The speed (X). comparing the linear regression models for the four
quadratic term coefficient, although less important in treatments (0 and 1 6 : 0 and 16.8 kg loads: L and S: linear and
reducing the error sum of squares, was also significant swinging motions).
Table I. Quadratic models fitted to data from each of the four treatments.
18. R. Rajagopalan, "'An ultrasonic robot collision detection sys- 8086/8088 Family: Architecture, Programming and Design,
tem", unpublished M.S. thesis, Auburn University, Graduate Prentice-Hail, Englewood Cliffs, 1986.
School, Auburn University, Alabama, 1990. 21. R. P. Paul, Robot Manipulators: Mathematics. Programming
19. Robot Programming Manual CK 09-1401E, ABB Robotics Inc., and Control, MIT Press, Cambridge, MA, 198l.
16250 W. Glendale Drive, New Berlin, Wisconsin, 1984. 22. SAS Institute Inc., SAS User's Guide: Statistics, Version 6.03
20. Y.-C. Liu and G. A. Gibson, Microcomputer Systems: The Edition, SAS Institute Inc., Cary, NC, 1988.