Professional Documents
Culture Documents
Lane Keeping Assist System For Passenger Cars
Lane Keeping Assist System For Passenger Cars
Jochen Pohl
Jonas Ekmark
Volvo Car Corporation
Dept. 96260, PVH 34
SE-405 31 Gothenburg
Sweden
Paper No. 529
Pohl, 1
In terms of this definition the system presented here therefore an offset torque to the base assist torque.
falls in the category of intervention systems, since the In contrast to the Lane Keeping Aid Systems
driver perceives a torque feeling in the steering wheel presented by Naab et al.(1994) and by Renault,
which mediates the correct lane position but still can where an extra actuator on the steering column is
be overridden by the driver. However, the type of used in order to produce the additional torque
intervention provided is of importance as well, i.e. requested by the system, an Electric Power
how the torque is built up. In Pohl et al (2003) an Assisted Steering (EPAS) gear is used.
intervention system for unintended roadway departure An important issue is how the steering wheel
is discussed, where the principle of operation is a torque relates to lane position and how this torque
steering wheel torque which is related to the vehicle is perceived by the driver. The Lane Keeping Aid
lateral position and speed in relation to the lane module shown in figure 1 consists of several sub
boundaries. This approach is extended here taking modules, namely a vehicle state observer, steering
lateral vehicle dynamics into account, so that the angle calculation, torque calculation as well as an
torque signal guides the driver back in lane. intervention module.
Lane Tracker
EPAS
Driver
Road
Lateral Position
Figure 1. Principal System Layout for a Lane Keeping System
In this paper, both the underlying theory for such a The task of the vehicle state observer is to calculate
lane keeping system as well as test track the required vehicle states as well as road geometry
measurements with test participants will be presented data from camera and vehicle data. From these
and discussed. signals the optimal steering angle is computed,
which is translated into a steering wheel offset
2. LANE KEEPING MODULE torque by the torque calculation module. This
torque is superposed on the basic power steering
Figure 2 shows the principle layout of the required assist characteristic. The intervention module
hard and software modules as they have been finally determines whether all required conditions
implemented in the test vehicle. A CCD camera is for a steering intervention are fulfilled, as well as
used in order to detect the current lane position, while duration of this intervention. Intervention criteria
an Electric Power Assisted Steering (EPAS) actuator are for instance the current lane position, indicator
is used in order to generate the required offset torque and brake pedal activity as well as whether the
in the steering column. As the EPAS is primarily used driver has his/her hands on the steering wheel or
for power assisted steering, it provides an assist torque not. The individual modules are discussed in detail
which is determined by the boost curve and the in the following sections.
current driving conditions. The lane keeping torque is
Pohl, 2
Camera Lane Keeping Module
Vehicle State Steering Angle Torque
Intervenion
Observer Calculation Calculation
Driver
EPAS
Steering Gear
2.1 Vehicle State Observer account, should be used. Figure 3 depicts the
bicycle model with state variables yaw rate Ψ & ,
In order to establish the vehicle state observer, where sideslip angle β and lateral force on both front Ff
even state variables of the road are included, several and rear axle Fr.
sets of equations describing vehicle motion, road Using the equations of motion round the vehicles
geometry and the discrete state observer equations center of gravity yields:
itself are required.
F f (α f ) + Fr (α r ) = ma n (1)
2.1.1 Vehicle Equations of Motion. The vehicle F f (α f ) ⋅ a − Fr (α r ) ⋅ b = Jψ&& (2)
model used here is a so called bicycle or one-track
model, where the vehicles roll motion (rotation round The lateral acceleration aL is related to yaw rate
x-axis, see figure 3), pitch motion (rotation round and sideslip angle time derivative by equation (3):
y-axis) and bounce (z-axis) are neglected. These (
a L = vt ⋅ ψ& + β& ) (3)
simplifications reduce the order of the model to four The lateral forces Ff and Fr are functions of the
degrees, namely yaw rate, sideslip angle and side sideslip angle
force on both front and rear axle.
F f = C f ⋅ α f , Fr = C r ⋅ α r (4)
In equation (3) Cf and Cr are the cornering
vf αf
a stiffnesses of front and rear tires respectively. The
tire sideslip angel at front and rear can be
δ v calculated from yaw rate, vehicle sideslip angle and
β
wheel angle:
ψ& ⋅ a ,
Ff
ψ b
αf =δ −β −
v (5)
vr αr ψ& ⋅ b
α r = −β +
v
Equations (1) to (5) lead finally to the two state
equations for sideslip angle and yaw rate:
Fr 1
β& = - (C f + C r ) β
Figure 3. Bicycle Model mv
1 1 (6)
The vehicles front and rear axle track is thus set to - (m ⋅ v 2 + C f ⋅ a + C r ⋅ b)ψ& - ⋅ C f ⋅δ H
mv mv
zero and the front and rear tires are lumped to one
single tire respectively. Both wheels on one axle thus
share the same steering angles and each wheel 1
ψ&& = (C f a - C r b ) β
produces the same side force. These simplifications J
(7)
are reasonable for driving scenarios with moderate 1 1
side accelerations (< 0.4 g on normal dry asphalt - (C f a 2 - C r b 2 )ψ& - C f ⋅ a ⋅ δ H
J J
roads, (Milliken and Milliken, 1995)) and constant
vehicle speed. However, when it comes to test cases 2.1.2 Lateral Vehicle Motion Relative Lane
with higher side accelerations and/or acceleration and Boundaries. In the following required relations for
braking, a more complete vehicle model that even lateral vehicle control are reviewed, see figure 4.
takes the vehicles roll and pitch characteristic into
Pohl, 3
Right line
2.1.3 State Observer. Kalman filtering is a well
known estimation technique. When the system
yR dynamics vary with time then the system matrices
needs to be updated in every time step which
Middle of lane requires a time dependant Kalmanfilter. A discrete
dp state space can be described as:
θ∆
δ x(t + 1) = Fx(t ) + Gu (t ) + v1 (t )
(12)
y (t ) = Hx(t ) + v 2 (t )
where x are the system state variables (namely
β v body sideslip angle, yaw rate, lateral distance to
lane boundary, heading angle and road curvature),
R
y0 y 0R
u the input signal and y is the output signal (here
OC
ψ the state vector). The matrices F and G are
obtained from the previous derived equations in a
straightforward manner. These are time dependent
due to the time dependency of the vehicle velocity.
Here T is the sampling time.
The measurement update of the states is given by
Figure 4. Lateral Vehicle Motion Relative Lane feedback of the innovation, i.e. the difference
Boundaries between the estimated and the measured signal.
xˆ (t | t ) = (13)
The motion of the vehicle relative to a given path,
here prescribed by the road geometry, can be xˆ (t | t − 1) + L(t )( y (t ) − Hxˆ (t | t − 1))
described by the vehicle heading angle Θ ∆ and the The measurement update of the error covariance
matrix P is given by:
lateral distance to the lane markings at the vehicles
center of gravity, here denoted as y0r and y0r for the P (t | t + 1) = P (t | t − 1) − P (t | t − 1) H T (14)
right and left lane marking respectively. ( HP (t | t − 1) H T + R2 ) −1 H P (t | t − 1)
& v (8)
θ ∆ = −ψ& +
R The calculation of the Kalman gain L takes into
y& 0 R = y& 0 L = v sin( −Θ ∆ − (− β )) (9) account the uncertainty of the estimates and
measurement noise R2.
≈ v(−Θ ∆ + β ) = vβ − vΘ ∆ L = P(t | t − 1) H T (15)
In order to determine the rate of the heading angle
form equation (8), the road radius must be measured. ( HP(t | t − 1) H T + R2 ) −1
This can be done directly by the camera system in The time update of the P-matrix is given by:
case the video image is processed at several preview
P(t + 1 | t ) = F P(t | t ) F T + R2 (16)
distances. However, this requires a camera with a
comparably long look ahead distance. If the road Finally, the time update of the state estimate, i.e.
radius or curvature (the inverse of the radius) cannot the new state vector, is given by:
directly be obtained from the camera system, it can be xˆ (t + 1 | t ) = Fxˆ (t | t ) + Gu (t ) (17)
calculated from the following equation, taking the From the estimated state vector the optimal steering
vehicle motion into account. angle and steering wheel offset torque are
Dp 2 calculated as explained in the following. A
y L = Dp ⋅ θ ∆ + y 0 L + (10) thorough treatment of Kalman filter techniques and
2R applications can be found in Gustafsson et. al.
Dp 2 (2001).
y R = Dp ⋅ θ ∆ + y0 R + (11)
2R 2.2 Steering Angle and Torque Calculation
Equations (6)-(11) describe the required relations for Modules
the estimation of vehicle and road state variables from
lane position and vehicle yaw rate measurements. The steering angle module calculates the optimal
steering angle in order to guide the vehicle back
into lane using the observed states from the
observer.
Pohl, 4
δ opt = applied LK-torque. In the road environment cluster
conditions regarding curvature, distance to lane
b a m marking and heading angle are included. If all
− v 2 + (a + b ) β steer ⋅ κ (18) conditions from the driver and vehicle cluster are
C f Cr (a + b ) fulfilled, intervention shall occur when the vehicle
enters the intervention zone indicated in figure 4,
+ K Θ∆ (v) ⋅ Θ ∆ + K y 0 (v) ⋅ y0 and end when the heading angle is below a certain
The optimal steering angle δ opt is calculated using threshold. The time history of the applied torque is
shown as well. This torque will guide the driver
curvature, heading angle and vehicle lateral back in lane outside the control zone.
displacement at the center of gravity. The curvature
can be seen as an outer disturbance thus being feed 2.3.1 "Hands On" Detection. An integral
forward, while heading angle and lateral displacement component of lane keeping systems where the
are "feedback" signals. The gains for the latter are steering characteristics are changed due to lane
linearly dependent on the vehicle speed, and the position is a device which prevents the driver from
curvature gain is obtained from the well known steady misusing the system as an auto-pilot as stated by
state cornering equation. Balzer. The driver must always be kept “in the
The torque calculation module consists of a feed loop” and is thereby ultimately responsible for the
forward and feedback path, with two vehicle speed control of the vehicle. Such a device could be a
dependent coefficients: steering wheel which is sensitive to pressure on the
T = K ff (v ) ⋅ δ opt + K (v ) ⋅ (δ opt − δ ) (19) steering wheel rim, in order to detect whether the
driver has his/her hands on the steering wheel or
2.3 Intervention Module not. Thereby an extra sensor is added to the system,
which increases system costs.
The task of the intervention module is to make Here the existing steering column torque sensor of
decision whether an intervention should occur and the the EPAS system is used in order to estimate the
duration of the same. The basic intervention strategy amount of torque which is applied on the steering
is illustrated in figure 5. Steering intervention should wheel by the driver. The correct estimation of the
occur, when a set of conditions are fulfilled. These driver’s torque is essential for the proper
conditions can with advantage be arranged in different functioning of the “Hands on” detection. If the
clusters, such as driver, vehicle and road/environment torque applied on the steering wheel is understood
clusters. as an outer disturbance, a Kalman filter which
The driver cluster contains information regarding the includes a simple model of the column assembly
driver status in terms of drowsiness and distraction, as can be used. Such a Kalman filter requires a set of
well as whether the driver has his/her hands on the observable measurements, here we use the pinion
steering wheel or not. A method for deriving this torque (as the torque sensor of the EPAS steering
signal making use of the steering column torque gear is used) and the steering wheel angle, see
provided by the EPAS system is discussed in the figure 3.
following section. In figure 5, TS represents the sensor torque, TH
The vehicle cluster contains conditions about the represents the driver’s torque, TˆH represents the
vehicle states, such as vehicle speed, acceleration, estimated driver’s torque, L the Kalman gain
braking, indicator operation, lateral acceleration and (calculated from the covariance matrices from
Pohl, 5
process and measurement noise), BV the viscous Measured Sensor and Estimated Driver Torque
friction coefficient, α the steering wheel angle and J 0.8
the steering wheel inertia. For real time applications
0.6 Sensor Torque
the filter needs to be transformed into the discrete
time domain which is straightforward using for
instance the zero-order hold transform. 0.4
Torque /[Nm]
“Hands Off”
0.2
-0.2
-0.4
“Hands On” Estimated Driver Torque
-0.6
0 4 2 6 8 10
Time /[s]
Figure 6. Torque Signals TH and TS of the
Steering Column Assembly from Figure 5
Pohl, 6
therefore been asked to drive the vehicle on a test
track. The test participants have not been informed
about the real intend of the experiment, they have
rather been informed that their driving capability
during distraction is measured. The experiment has
been conducted on a closed track with only few
other vehicles, and without oncoming traffic. In
contrast to situation in real traffic, where severe
distraction can result in dangerous situations, the
drivers felt safe during the test, despite of larger
lane deviations.
In order to produce lane deviation the test
participants were severely distracted by several
tasks they were asked to perform. These tasks
started with changing radio channel, storing new
channels in the radios memory, answering a cell
Figure 8. Measured Lane Position, i.e. Distance to phone and finally sending text messages from the
Left and Right Lane Marking same. A few test participants refused to execute
certain tasks, as that might result in dangerous
driving situations. This is important to have in
mind when it comes to the evaluation of the
questionnaire filled in by the test persons after the
study. The fact that the usefulness of the system
has been judged from proving ground driving only,
influences surely the answers of the test
participants on the test protocol.
It has to be mentioned that the test leader observed
both the amount of LK torque and the test
participant during the distraction tasks. It is
interesting to note that the participants were highly
occupied with the distraction tasks, that none
commented on the steering intervention. Directly
after the individual test programs were carried out
the participants were asked if they liked the
Figure 9. Applied Lane Keeping Torque handling properties of the vehicle. Several drivers
found the steering to behave strangely (see below),
A close inspection of the lane position in figure 8 but could not relate this behavior to the driving
produces the impression of an oscillatory system situation.
behavior. However, it has to be kept in mind that the After the driving test the drivers were asked to
recorded sequence covers 15 seconds at a vehicle answer the following six questions, in a
speed of 70km/h. The peak value of the lane keeping questionnaire: table 1.
torque is 1.5 Nm and the main duration about 10 1) How was your first impression of the system?
seconds. It has to be added that it is hard to assess the Since the test participants were not used to such
system performance from simulation or measurements kinds of systems, they ascribed the vehicle
only. Test and tuning has to be an integral part of the behavior to a number of different reasons, as for
design procedure. However, the final judgement is to instance power steering malfunction or miss-
be made by the vehicle driver that the system is aligned front wheels.
intended for. Concequently, human-machine aspects 2) Was the functionality of the system easy to
in terms of system transparency are of major understand?
importance. Tests with different drivers have been All test participants claimed that the system
carried out in order to investigate these issues. operation was far from being intuitive, and
suggested an additional HMI in form of a
4. TEST DRIVE RESULTS designated lamp in the visual field.
3) Did the force given in the steering wheel bother
A decisive question in terms of customer acceptance, you?
and whether a lane keeping system like the one The majority of the test participants were not
described here truly reduces the amount of single disturbed by the additional torque, however, two
vehicle accidents is if the driver intuitively compared the function with lecturing the driver.
understands the systems function, without knowing 4) Did the system support you in your driving?
that a LKAS is active. Twelve participants have
Pohl, 7
The drivers stated that the system lulls the driver in a which today unfortunately still lack the required
sense of false security. robustness in terms of varying lightning conditions
5) Did the system perform any incorrect maneuvers? and varying drivers.
The test participants found the amount o torque
applied on the steering wheel both to high and too 6. NOMENCLATURE
low, which points out the need for a personalized
setting of the LK-function. β sideslip angle [rad]
6) Would you like to have a system like this in your κ road curvature [1/m]
car? θ∆ heading error [rad]
α f ,α r front/ rear wheel angle [rad]
The questions were answered by ranking them on a
scale from zero to ten, where ten is the perceived δH wheel angle [rad]
highest satisfaction. The mean value of the ranking, βsteer gearing ratio [-]
by question, is shown in table 1. a, b position of CG [m]
aL lateral acceleration [m/s2]
Table 1. Mean Values by Question Cf, Cr cornering stiffness front, rear [N/rad]
Dp camera measurement distance [m]
Question Mean Value F various forces [N]
1 5.1 F, G, H system, input, output matrix
2 7.1 J vehicle inertia aroiund z-axis [Nm·rad/s2]
3 6.3 K various gains
4 5.7 L observer gain
5 7.2 m vehicle mass [kg]
6 6.6 P covariance matrix
R road radius [m]
The result indicates a promising satisfaction with the T various torques [Nm]
system. The majority of the test participants would v vehicle speed [m/s]
like to have such a system installed in their own v1, v2 noise vectors
vehicle, if it is reasonably priced. However, it has to x, y, u state, output, input vector
be remembered that the small size of the test group y0 lane position [m]
does not represent any statistical result. &
Ψ yaw rate [rad/s]
5. CONCLUSIONS 7. REFERENCES
In this paper design issues for a Lane Keeping Aid ADAC (2001), Verunglückte nach Unfallart,
System are discussed, covering basic system http://www.adac.de.
requirements, algorithm modules and human machine Balzer, D, (2002), Safety enhancement by lane
interface aspects. The presented system has been observation of Advanced Driver Assistance
tested on twelve drivers, who did not know the real Systems (ADAS), VDA, Technical Congress 2002,
intend of the test. In that manner, system Germany.
transparency, i.e. whether the system function is Gustafsson F, Lung L, Millnert M, (2001)
intuitive or not, could be investigated. Signalbehandling, Studentlitteratur, page 289-332.
The result of this investigation is twofold: Naab K, Reichart G, (1994), Driver Assistance
• The haptic interface as HMI in the steering wheel Systems for Lateral and Longitudinal Vehicle
is in itself not sufficient. It is suggested that a Guidance - Heading Control and Active Cruise
multi-modal HMI is integrated to increase the Support, Paper No 78, AVEC 94.
driver’s awareness about system operation. The Pilutti, T E, (1997), Lateral Vehicle Co-Pilot to
HMI could incorporate a Head-up-Display or avoid Unintended Roadway Departure, PhD thesis,
simply a standard symbol in an appropriate Dept. Mechanical Engineering, The University of
position together with the haptic steering wheel. Michigan.
• In order to reduce the amount of nuisance Pohl J, Ekmark J, (2003), Development of a
warnings, the system needs additional Haptic Intervention System for Unintended Lane
information about the drivers' state in terms of Departure, SAE Paper 2003-01-0282, SAE World
distraction and drowsiness. Congress, SAE international.
Renault safety site, www.conceptsecurite.renault.fr
The next step towards a full-fledged Lane Keeping /demain/einxc5.htm.
Aid System therefore includes detection of drivers’
state, by e.g. integrating vision based driver monitors,
Pohl, 8