Documente Academic
Documente Profesional
Documente Cultură
wheel and the passengers confort [7], [8]. In this case the where x = [ , r, L , yL , f , f ] is the state vector (side slip
system has both a comfort and a safety function. On the angle, yaw rate, relative yaw angle, lateral offset, steering
opposite, lane departure avoidance systems are intended to angle, steering angle rate), Ta is the assistance torque provided
increase driving safety, even if passengers confort is not by an electrical motor mounted on the steering column, Td
always preserved [3]. They act by short interventions when the drivers torque and re f the road curvature. The system
the vehicle is about to exceed the boundaries of the lane, and matrices are given by:
A=
(2)
lS
v 0
0
0
avoidance systems can use the same principle of vehicle
,
v
0
0
0
0
0
1
T
2(l c l c )
minoiu,netto,glaser@lcpc.fr
S. Mammar Member IEEE IBISC/CNRS-FRE 3190 Universite dEvry
Val dEssonne, 40 Rue du Pelvoux CE 1455, 91025, Evry, Cedex, France.
said.mammar@iup.univ-evry.fr
119
a21 = r r J f f ,
cr = cr0 ,
2c
b1 = mvf ,
2Kp c f t
TS = RS ,
a22 = r Jv f ,
c f = c f 0 ,
2c l
b2 = Jf f ,
2Kp c f l f t
TSr = RS v .
(5)
(6)
with w1 R, |w1 | 1.
The steering assistance torque satisfies the control law
developed in [12]: Ta = Kx + Ff re f (K R16 , Ff R).
This control law combines a state feedback gain K with a
feedforward action of the road curvature of gain Ff . The
assistance has been designed to get activated when the vehicle
is drifting off the lane due to a drivers lapse of attention.
Its control law has been designed to minimize the lateral
displacement of the vehicle front wheels and to keep it
always below an upper bound, despite the road curvature.
After activation and lane departure avoidance, the steering
assistance steers the vehicle to follow the lane.
In [12], the drivers actions on the steering wheel has
been considered to be bounded to a small value (|Td | Tdmin )
and has been neglected since the driver has been supposed
inattentive during the assistance intervention.
In this paper, the assumption has been made, that the driver
can act on the steering wheel with a limited torque |Td |
Tdmax . Using a scaled parameter as above, w2 R, |w2 | 1,
the system description becomes
x = Acl x + Bw1 w1 + Bw2 w2 , where
d
and
w2 = TTmax
d
max (B + B F ), B
max .
Acl = Ax + Bu K, Bw1 = re
u f
w2 = Bu Td
f
Fig. 1.
(8)
(9)
ATcl P + PAcl + 1 P
BTw1 P
BTw2 P
0
(7)
PBw1
2
0
0
PBw2
0
3
0
0
0.
0
1 + 2 + 3
(10)
QATcl + Acl Q + 1 Q
BTw1
BTw2
0
Bw1
2
0
0
Bw2
0
3
0
0
0.
0
1 + 2 + 3
(11)
(zi )
Q
0,
i = 1, . . . , 32,
(12)
trace(Q)
i > 0, i = 1, . . . , 3,
Q 0,
eq. (11), eq. (12).
(13)
The decision variables of the above BMI optimization problem given in (eq. (13)) are the matrix Q = QT , Q R66 and
the real scalars i R+ , i = 1, . . . , 3.
120
Fig. 3.
Fig. 2.
(vk )T Qk vk
k
i > 0, i = 1, . . . , 3,
Qk 0,
eq. (11), eq. (12),
yr = yL + (l f lS )L 2a ,
(15)
a 1p
+
fQfT.
2 2
(16)
Consequently, in order to obtain an invariant ellipsoid containing the reachability set and that gives a minimum upper bound
of the front wheels displacement on the lane, the following
BMI optimization problem has to be solved:
(14)
min
fQfT
i > 0, i = 1, . . . , 3,
Q 0,
eq. (11), eq. (12).
(17)
121
Fig. 6.
Fig. 4.
A x + B u + Lob (y C x ),
(20)
Fig. 7.
B s + K s + Ta + Td Tr .
(18)
= K s
Is
Td
0
B s
Is
1
Is
+ 1
Is
Td
0
0
1
Is
Ta
Tr
.
(19)
122
in (eq. (14)) and (eq. (17)) using the PENBMI solver [17]
along with YALMIP [18].
After solving the optimization problem given in (eq. (14)),
the maximum values of the vehicle state under the simultaneous action of the steering assistance and of the driver are
given in Table II. The results of the optimization problem of
(eq. (17)) is a maximum lateral displacement for the front
wheels of 2.19 m with respect to the center of the lane.
TABLE I
L IMITS OF THE NORMAL DRIVING REGION L (Z N ).
N
1.84
0.03rad
rN
23 /s
0.40rad/s
LN
2.3
0.04rad
yN
L
0.23m
0.23m
fN
2.3
0.04rad
N
f
6.9 /s
0.12rad/s
TABLE II
G UARANTEED VEHICLE STATE LIMITS DURING
DRIVER - ASSISTANCE
INTERACTION .
max
8.65
0.15rad
rmax
56.37 /s
0.98rad/s
Lmax
15.54
0.27rad
ymax
L
1.59m
1.59m
fmax
11.00
0.19rad
Fig. 9.
max
f
87.83 /s
1.53rad/s
Fig. 10.
Fig. 11.
Road curvature.
V. C ONCLUSIONS
This paper investigates the feasability of an integrated lane
departure avoidance assistance with a lane keeping assistance
system. While the lane departure assistance system has been
already designed and tested in [12], the main focus in this
paper is on the lane keeping performance of the steering assistance system under drivers action, for straight and curved
roads. A theoretical method based on invariant sets and BMI
optimization has been proposed to compute bounds on the
state variables and on the front wheels lateral displacement
in case of mixed action driver - steering assistance system.
The computed bounds are subsequently tested with an instrumented prototype vehicle on a test track. All theoretical
computed bounds have been verified in practice.
The most relevant contributions of this paper are
1) the use of a general theoretical method on a concrete
vehicle application;
2) the total compliance of the theoretical results with the
experimental results;
123
(a)
(d)
Fig. 8.
(b)
(c)
(e)
(f)
[13] K. Nagpal, J. Abedor, K. Poolla, An LMI Approach to Peak-toPeak Gain Minimization: Filtering and Control, Proceedings of the
American Control Conference, pp. 742-746, Baltimore, Maryland,
1994.
[14] N. Minoiu Enache, B. Lusetti, S. Mammar and M. Netto, Assistance
preventive a` la sortie de voie : Cas de la conduite en virage (Driver
steering assistance to lane departure avoidance: Case of curvy roads),
CIFA, Bucarest 2008.
[15] R. Labayrade, J. Douret, J. Laneurit and R. Chapuis, A Reliable
and Robust Lane Detection System based on the Parallel Use of
Three Algorithms for Driving Safety Assistance, IEICE Trans. on
Information and Systems Online, Vol. E89-D, No. 7, pp. 2092-2100,
2006.
[16] D.G. Luenberger, An introduction to observers, IEEE Trans. on
Automatic Control, Vol. 16, pp. 896-602, 1971.
[17] M. Kocvara and M. Stingl, PENBMI Users Guide (Version
2.1), PENOPT GbR, Igensdorf OT Stockach, Germany, 2006.
http://www.penopt.com.
[18] M. Grant and S. Boyd, CVX: Matlab software for disciplined convex
programming (web page and software), http://stanford.edu/boyd/cvx,
2008.
124
A PPENDIX
TABLE III
V EHICLE PARAMETERS VALUES
Parameter
BS
cf0
cr0
IS
J
KP
lf
lr
lS
a
m
RS
v
t
Value
steering system
damping coefficient
front cornering stiffness
rear cornering stiffness
inertial moment of steering system
vehicle yaw moment of inertia
manual steering
distance form CG to front axle
distance from CG to rear axle
look-ahead distance
vehicle width
total mass
steering gear ratio
longitudinal velocity
tire length contact
adhesion
lane width
15
40000 N/rad
35000 N/rad
0.05kgm2
2454 kgm2
1
1.22m
1.44 m
0.98m
1.5m
1600 kg
16
16m/s
0.13m
1
3.5m