Professional Documents
Culture Documents
16th Triennial World Congress, Prague, Czech Republic
16th Triennial World Congress, Prague, Czech Republic
Antonella Ferrara
301
2. COLLISION DETECTION
302
A V F
Finally, to give a better evaluation of a future
collision situation, one needs to know the possible
R b behavior of the obstacle. The idea is to make
C
F a one-step-ahead prediction of all the quantities
necessary to construct the collision cone relying
r B on an autoregressive model (ARM) as suggested
f in (Elnagar and Gupta, 1998), so as to be able
V O g g to determine a “predicted” collision cone. Then,
the output of the “Collision detection unit” of the
supervisor (Fig. 1) can be based on a weighted
a evaluation of the collision cone and of the “pre-
q
dicted” collision cone.
O
303
on the basis of the knowledge of the current “rel-
y d evant” collision cone. Indeed the position of the
V x current velocity vector of the vehicle inside the
a u cone gives indications on how a collision could
v
be avoided: the idea is to steer the car and to
z vary the magnitude of the velocity vector in such
Y a way that the driving direction moves outside the
a cone. The controller which is activated in Phase
b 2 (low level controller 2 ) makes the car track the
Y l reference trajectory given by a line parallel to the
Z X road border and distant from it of an offset equal
to 1.5m. Moreover, both the controllers produce
Fig. 3. The bicycle model an action on the traction/braking torque so that
an appropriate reference velocity ud is tracked
3.2 The Control Actions
during both phases.
A collision avoidance control systems for pre–
crash application is a critical system, in the sense 3.4 Steering angle control in Phase 1
that a number of physical aspects and constraints
need to be considered to generate a safe ma- To generate the steering command in Phase 1,
noeuvre. This is the reason why a supervisor has introduce the sliding quantity
been included in the control scheme: its aim is to
predict, on the basis of the information available Zt
at each sampling instant, if a collision with some S1 = ξ˙ + λ11 ξ + λ12 ξdτ (16)
VRU or which some other obstacle detected by the 0
sensors is going to occur in the close future, as well
as to establish if a collision avoidance manoeuvre where λ11 , and λ12 are design parameters on
is applicable (or, in contrast, if, by making the which the dynamics of the vehicle depends once
manoeuvre, a collision with a different obstacle the sliding manifold is reached, and ξ represents
is likely). If the manoeuvre is not feasible, an the error between the actual car direction and the
emergency braking is produced so as to reduce, border of the collision cone closer to the actual car
at least, the energy at the impact. The emergency direction: both quantities are expressed in terms
braking action can be open–loop, because of its of the angle with respect to the original driving
emergency nature. In particular, in our case, we direction, i.e.,
assume that if this kind of action needs to be per- ξ = αcar − αc (17)
formed, it is realized by making the car brake with
the maximum admissible deceleration. Otherwise,
The control law can be chosen as
if the collision avoidance manoeuvre is feasible, a
high level controller in charge of the generation of KS
δ = − 1 sign (∆) sign (S1 ) (18)
the manoeuvre is activated. To produce a correct ∆
manoeuvre, the controller requires that a refer-
where KS1 is a design parameter which takes into
ence trajectory is available at any time instant
account the physical and passenger comfort limit
during the bypassing movement. To simplify the
δmax , and
reference trajectory generation, the movement of
the car during the collision avoidance manoeu- a(cf + T )
∆= (19)
vre has been divided into two phases: Phase 1, Jz
collision avoidance movement; Phase 2, re–entry
movement. Note that, since in practical application of sliding–
mode control the so–called chattering phenomenon
may arise, it is advisory to enlarge the collision
cone with a safety margin, and so consider a
3.3 The Sliding–Mode Based Low Level Controllers slightly “expanded” cone to be sure that the ac-
tual car direction during the obstacle avoidance
The two low level controllers in Fig. 1 have been manoeuvre is forced outside the true collision
designed relying on a sliding–mode control ap- cone.
proach (Utkin, 1992). The controller which is ac-
tivated in Phase 1 (low level controller 1 ) makes
the car track the collision avoidance curve approx- 3.5 Steering angle control in Phase 2
imated, during the interval between the arrivals
of two subsequent pieces of data from the sensors, To generate the steering command in Phase 2,
with its tangent line. Such a curve is determined introduce the sliding quantity
304
Zt
S10 = ẏs + λ011 ys + λ012 ys dτ (20)
0
pedestrian 3
0.5
0.2
Zt
0.1
S2 = ε̇ + λ21 ε + λ22 · εdt (22) pedestrian 1 pedestrian 2
0
0
−0.1
0 1 2 3 4 5 6
where λ21 , and λ22 are again design parameters. road length [m]
time. 0.06
0.04
steering angle [rad]
0.02
−0.04
0.5
a first experiment with three still pedestrians are
0.4
reported in Figs. 5–8, while those relevant to a
second experiment with three pedestrians moving 0.3
time [sec]
cause of sensor noise, unpredictable time–varying
actuator offsets, and limitations imposed on the Fig. 7. The speed of the controlled car during the
sampling time by image processing, the car tra- first experiment
jectory is less smooth than in simulation.
305
3
2.5
2.5
1.5
1.5
1 1
0.5
0.5
0
0 2 4 6 8 10 12 14
0
0 2 4 6 8 10 12 time [sec]
time [sec]
Fig. 8. The minimum value of the distances with Fig. 12. The minimum value of the distances with
respect to the pedestrians during the first respect to the pedestrians during the second
experiment experiment
5. CONCLUSIONS
0.6
The present paper explores the possibility of de-
pedestrian 2
0.5 signing a pre–crash automatic collision avoidance
0.4
pedestrian 3
system for cars. Satisfactory experimental results
on a scaled vehicle have been provided in this
road width [m]
0.3
paper. Yet, this work is in progress, and a number
0.2
of crucial aspects still need to be analyzed before
0.1
pedestrian 1
starting the required experimentation on a car
0 prototype.
−0.1
0 1 2 3 4 5 6
road length [m]
REFERENCES
Fig. 9. Trajectory of the controlled car and of the
pedestrians during the second experiment Chakravarthy, A. and D. Ghose (1998). Obstacle
avoidance in a dynamic environment: a col-
0.1 lision cone approach. IEEE Transaction on
0.08 Systems, Man and Cybernetics 28, 562–574.
0.06 DeNicolao, G., A. Ferrara and L. Giacomini
0.04 (2002). A collision risk assessment approach
as a basis for the on–board warning genera-
steering angle [rad]
0.02
0
tion in cars. Proc. IV’2002 IEEE Intelligent
−0.02
Vehicle Symposium, Versailles, France.
−0.04
Elnagar, A. E. and K. Gupta (1998). Motion pre-
−0.06
diction of moving objects based on autore-
−0.08
gressive model. IEEE Transaction on Sys-
−0.1
0 2 4 6
time [sec]
8 10 12 14
tems, Man and Cybernetics 28, 803–810.
Ferrara, A. and L. Giacomini (2004). Genera-
Fig. 10. The steering control input during the tion of collision avoidance manoeuvres in pre–
second experiment crash driver assistance systems. Proc. First
IFAC Symposium on Advances in Automo-
1.4 tive Control, Salerno, Italy.
1.2
Genta, G. (1997). Motor Vehicle Dynamics. World
Scientific.
1
Guldner, J., W. Sienel, H.-S. Tan, J. Ackermann,
R/C car speed [m/sec]
time [sec]
1999-10107 PROTECTOR, Concept Mod-
elling. Deliverable No. D05.4.
Fig. 11. The speed of the controlled car during the Utkin, V.I. (1992). Sliding modes in control and
second experiment optimization. Springer Verlag. Berlin.
306