Professional Documents
Culture Documents
Abstract
This paper describes a comparative study of steering and yaw moment control manoeuvres in the model predictive control and linear quadratic control approaches for path-following control of an autonomous vehicle. We present the effectiveness of the model predictive control and linear quadratic control approaches for stability control of the vehicles
lateral position and yaw angle for different control manoeuvres: two-wheel steering, four-wheel steering and direct yaw
moment control. We then propose model predictive control with a feedforward controller to minimize the tracking
errors of the lateral position and the yaw angle in an active front steering manoeuvre, and these are compared with the
results from linear quadratic control that has a feedforward controller. Model predictive control is designed on the basis
of the simple yawlateral motions of a single-track vehicle with a linear tyre model (i.e. a bicycle model), which is an
approximation of the more realistic model of a vehicle with double-track yawroll motion with a non-linear tyre model
(i.e. the Pacejka model). The linear quadratic controller is designed on the basis of the same approach as adopted for the
model predictive controller to achieve a fair comparison. On the basis of a given trajectory, we simulate the manoeuvre
of the vehicle at a low speed, a middle speed and a high speed because load transfer effects will influence the roll
dynamics especially at a high speed. We also perform simulations on low-road-friction surfaces in a double-lane-change
scenario with the aim of following the desired trajectory as closely as possible while maintaining the vehicle stability. The
simulation results show that model predictive control through two-wheel steering and four-wheel steering with direct
yaw moment control performed better in terms of trajectory tracking at a high forward speed and low road surface variation. The proposed model predictive control with a feedforward controller is shown to be effective in minimizing the
trajectory tracking errors. For all control manoeuvres, model predictive control gives a better tracking performance
than linear quadratic control does. In addition, when the roll dynamics are considered, model predictive control significantly improves the vehicle stability and the trajectory along the desired path.
Keywords
Autonomous vehicle, model predictive control, linear quadratic control, path-following control, feedforward controller,
manoeuvre control
Introduction
One of the most popular optimal control techniques
which is widely employed for controlling constrained
linear or non-linear systems is the model predictive control (MPC) technique. MPC uses a mathematical
dynamic process model to predict a future value and to
optimize the process control performance.1, 2 The MPC
model is easy to use at different levels of the process
control structure and offers attractive solutions for regulation and tracking problems3 while guaranteeing stability.4 On the other hand, linear quadratic control
(LQC), which is also based on a quadratic cost function, is widely implemented for process control5 and
1
Vehicle model
Double-track model
Figure 1 shows the well-known vehicle model, which is
a single-track model based on the simplification that
the right wheels and the left wheels are lumped together
as a single wheel at the front axle and the rear axle.
The simplified vehicle model used in this paper illustrates the motion and dynamics of the vehicle subject
to the longitudinal, lateral, yaw and roll motions representing the four degrees of freedom in the model. The
longitudinal, lateral and yaw dynamics effects are
shown from the top views of the vehicle in Figure 1(a)
and (b) for different control manoeuvres, whereas the
roll dynamics effect is illustrated from the side view
and the front view of the vehicle in Figure 1(c) and
Figure 1(d) respectively, together with the notation.
Figure 1. Simplified bicycle model: (a) 4WS; (b) 2WS with DYC; (c) side view; (d) front view.
1a
m
y = mx_ c_ + 2Fyf + 2Fy r + hmf
1b
+ Mz
= 2 lf Fyf 2 lr Fyf + Ixz f
Izz c
= mghf 2kf f 2bf f_
Ixx + mh2 f
_ + Ixz c
+ mh(
y + c_ x)
1c
Jb v_ wi = rw Fxi Tbi bw vi , i = ( f, r)
1d
1e
2a
_ x_ sin c + y_ cos c
Y
vx c + y_
2b
Fx = mx (s) Fz
Fyf f
huf Fyf
lr mg
kff f
bff f_
huf lr mgf
Fzf =
2
tw
2l
tw
tw l
tw
3b
Fzr =
Fyr f
hur Fyr
lf mg
kfr f
bfr f_
hur lf mgf
2
2l
tw
tw l
tw
tw
3c
Fx (s) = Dx sin Cx tan 1 Bx (1 Ex ) s + Ex tan1 (Bx s)
1
4a
By (1 Ey ) a + Ey tan1 (By a)
2.
4b
5a
5b
5c
3.
4.
h
i o
1n
_
Cr + Cf vy + Cr lr Cf lf m v2x c_
vx
+ Cf df + Cr dr
m v_y =
Control allocation
In this section, the linear MPC and LQC are explained.
The basic hierarchical control structure adopted for
MPC and LQC is shown in Figure 3. In the control
structure illustrated in Figure 3, a 2WS model using
only front steering, a 4WS model using front and rear
steering or a DYC model producing a reaction moment
at the front wheels and the rear wheels are used to control the vehicle so that it follows a given reference trajectory. It includes the vehicle speed, the desired
reference trajectory, MPC and a linear vehicle model
with a non-linear tyre model. LQC will be implemented
in the same way as MPC to facilitate a fair comparison.
6a
h
i
_
= 1 Cr lr Cf lf vy Cf l2 + Cr l2 c_
I zz f
f
r
vx
+ Cf lf df Cr lr dr + Mz
6b
Linear MPC
To implement MPC with a receding-horizon control
strategy, the following strategies are adopted.
1.
where Cf and Cr are the constants representing the linear cornering stiffnesses of the front tyres and the rear
tyres respectively.
For the DYC, the reaction moment occurring at
the front wheels and the rear wheels due to the
Mr 2 l r C r Mz
m
m
Izz
=
m
m=
_
I zz
y = Cx + Du
x
where x2R , u2R , wdes2R and y2R are the state vectors, the control input vectors, the desired trajectory
vectors and the measured output vectors respectively.
We define
T
x = vy Y c_ c
T
df dr ,
u = df ,
T
df M z
11a
Hp
y^ (k + ij k) wref (k + ij k)
2Qi
l
HX
c 1
D^
ul (k + ij k)
2
Ri
i=0
14
11b
12a
12b
respectively.
Jmpc x(k), Uk =
i=1
T
ul (k) = df Mz
13c
physical reasons (i.e. the ranges of the front-tyre torque, the rear-tyre torque and the moment torque), is
formulated as
min Jmpc xl (k), DUl (k)
DUk
subject to
x^l (k + 1jk) = Al xl (kjk) + Bl ul (kjk)
x^l (k + 2jk) = Al x^l (k + 1jk) + Bl u^l (kjk)
..
.
x^l (k + ijk) = Al x^l (k + i 1jk) + Bl u^l (k + i 1jk)
df, min 4 u^l (k + ijk) 4 df, max ,
2WS
dr, min 4 u^l (k + ijk) 4 dr, max ,
4WS
Mz, min 4 u^l (k + ijk) 4 Mz, max ,
DYC
D df, min 4 D u^l (k + ijk) 4 Ddf, max
D dr, min 4 D u^l (k + ijk) 4 Ddr, max
DMz, min 4 D^
ul (k + ijk) 4 DMz, max ,
i = 1, . . . , Hp
15
vy lf c_
vx
vy + lr c_
vx
16
18
LQC
To allow a fair comparison of the tracking responses
with those from MPC, LQC is also based on the linearized vehicle equations (6) with a quadratic cost function. The aim of this approach, called linear quadratic
tracking, is to track and follow the desired trajectory as
closely as possible, with the linear quadratic solution.36,
37
We denote the control error by eer(t), the desired trajectory by wdes(t) and the performance output by yl(t),
with these being related by
eer (t) = wdes (t) yl (t)
19
eer (t) dt
20
which is introduced as a new state to the dynamic system (6) as given in state space by
e_e
I
0 I
ee
0
wdes
=
+
u +
0
xl
x_ l
0 Al
Bl l
21
subject to
_
e(0) = e0
25
26
without exceeding the bandwidth and position limitations of the actuators, i.e. without so-called saturation.
where
Qlq =
CT Q11 C 0
0
Q22
28b
29
30a
30b
30c
= lim sX(s)
s!0
1
= A B1 kmpc
B1 kss + B2 wdes
ay = y_ + c_ vx
y_ = e_y ec vx
31
33
35
(kff ) =
vx
sRw
kff
s
0
2
ec
6
6
+6
6
4
1
0
Cf lf Cr lr
mvx
C f lf C r lr
mvx
Cf lf Cr lr
Izz vx
Cf + Cr
m
Cf lf Cr lr
Izz
322
33
ey
766 77
766 e_y 77
766 77
1 7
544 ec 55
Cf + Cr
mvx
Cf l2f + Cr l2r
Izz vx
2
0
6 Cf
vx 7
7
m
7 c_ des + 6
6
7
40
5
2
Cf l2f + Cr lr
Izz vx
C f lf
Izz
e_c
7
7
7 df
5
38
l
mv2
kmpc1 Rx w l Clrf Cfr +
6
6
xss = 6 0Cr lf lr Cr l2 + lf mv2
r
x
4
Cr Rw l
0
lf kmpc3
Cr
l lr kmpc3
kmpc1 Rw
kff
kmpc1
3
7
7
7
5
39
40
34
(wdes ) =
37
36
ec =
41
Parameter
Parameter
m
Ixx
Izz
Ixz
lf
lr
h,
tw
bf
kf
Cf
Cr
G
Value
1542
670
2786
166
0.92
1.77
0.55
1.02
4500
72,500
106,000
88,000
9.8
lr
lf mv2x
=
Rw
Cr Rw l
Value
Hp
Hc
Ts
df, dr
Ddf, Ddr
Mz
DMz
T
20
9
0.05
6 30
6 20
6 2000
6 1500
15
MPC
LQC
R1 = 0.1
Q11 = 2.05
Q22 = 0.5
R1 = 0.1
Q11 = 5.25
Q22 = 0.5
R1 = 0.1
Q11 = 2.65
Q22 = 0.65
R1 = 0.1
R2 = 0.1
Q11 = 2.85
Q22 = 0.2
R1 = 0.1
R2 = 0.1
Q11 = 3.15
Q22 = 0.5
R1 = 0.1
R2 = 0.1
Q11 = 3.55
Q22 = 3.05
R1 = 0.1
R2 = 0.1
Q11 = 2.15
Q22 = 0.5
R1 = 0.1
R2 = 0.1
Q11 = 4.55
Q22 = 0.5
R1 = 0.1
R2 = 0.1
Q11 = 5.15
Q22 = 1.05
Rlq = 5
Qlq1 = 10
Qlq2 = 1.5
Rlq = 5
Qlq1 = 20
Qlq2 = 2.5
Rlq = 5
Qlq1 = 12
Qlq2 = 2.8
Rlq1 = 5
Rlq2 = 5
Qlq1 = 4.65
Qlq2 = 1.55
Rlq1 = 5
Rlq2 = 5
Qlq1 = 14.5
Qlq2 = 2.55
Rlq1 = 5
Rlq2 = 5
Qlq1 = 9.5
Qlq2 = 4.15
Rlq1 = 5
Rlq2 = 5
Qlq1 = 5
Qlq2 = 1.5
Rlq1 = 5
Rlq2 = 5
Qlq1 = 10.4
Qlq2 = 2.55
Rlq1 = 5
Rlq2 = 5
Qlq1 = 8.5
Qlq2 = 2.35
44
2WS
vx = 10 m/s, m = 1
vx = 25 m/s, m = 1
vx = 20 m/s, m = 0.3
Simulation results
Scenario description
4WS
The linear MPC and LQC presented above were implemented in simulations for path-following vehicle control in a double-lane-change scenario. The double-lanechange manoeuvre approximates an emergency manoeuvre case and generally demonstrates the agility and
capabilities of a vehicle in terms of the lateral dynamics.
During such a manoeuvre, understeering, oversteering
or even rollover may occur. For these scenarios,
Table 1 shows the model parameters for a Ford Taurus
sport utility vehicle. Simulations were performed using
the MPC Toolbox in MATLAB and Simulink software. In this paper, the predictive controller was used
to minimize the deviation of the vehicle from the target
path to achieve the main aim, namely to follow the
desired or reference trajectory as closely as possible.
The controllers based on simple 2DoF vehicle motion
were compared with each other for a non-linear vehicle
system at a low forward speed (10 m/s) and a high forward speed (25 m/s) on an ideal road friction surface,
and at a medium forward speed (20 m/s) on a lowroad-friction surface (wet earth with snow; m = 0.3).
In this paper, both the model predictive controller
and the linear quadratic controller were designed and
implemented in the simulation scenarios, with the parameters and conditions given in Tables 2 and 3. The
weighting matrices for the inputs and outputs of MPC
and LQC were based on a trial-and-error process,
where the main target here is to achieve the zero-lateral-position error rather than the zero-yaw-angle
error. Here, the weighting matrices were selected on the
basis of the best-response outputs by first tuning the
outputs gain parameter, which was then followed by
tuning the input gains parameter.
vx = 10 m/s, m = 1
vx = 25 m/s, m = 1
vx = 20 m/s, m = 0.3
2WS + DYC
vx = 10 m/s, m = 1
vx = 25 m/s, m = 1
vx = 20 m/s, m = 0.3
10
manoeuvre, where, following a sudden turn, the steering wheel is then held fixed for the remainder of the test.
A fishhook test is a steering reversal manoeuvre, where
the vehicle turns with the steering angle changing from
0 to 270 and then from 270 to 600. The last test is
the double-lane-change test which is an avoidance test;
this represents a changing vehicle path based on predetermined cone placement in the road. In this paper,
we performed only the NHTSA J-turn and roll rate
feedback fishhook test for vehicle validation purposes
in the open-loop simulations, as shown in Figures 6 and
7. In these tests, we set the vehicle speed at 20 m/s which
is suitable for both tests with a road surface coefficient
of 1. Based on the vehicle responses for the yaw rate,
the roll rate and the lateral acceleration, it is proved
11
and shown that the vehicle model is validated and corrected; thus, it can be implemented for controller
design.
Since our research is conducted through a simulation
process, it is necessary to validate the vehicle model
through manoeuvre tests. Another way to strengthen
the proposed control methods is to compare the proposed controller with another controller. This way, we
are comparing two different controls for the same aims
and target, in order to validate and prove that the methods used are sufficiently accurate. Currently, we are
developing the vehicle prototype for our next study on
real implementation. To facilitate a comparison of the
robustness values and the performances of both controllers in stabilizing the vehicle at a chosen speed along
the desired trajectory, the controller tuning parameters
from Tables 2 and 3 were selected for all situations and
conditions of vehicle manoeuvres.
First, we performed a vehicle simulation test under
ideal road surface friction coefficients (dry asphalt; m
= 1) at a constant low forward speed of 10 m/s. The
MPC and LQC weight tuning parameters are listed in
Table 3. We evaluated the robustness values of the controllers for the output responses by comparing the performances of 2WS, 4WS and 2WS with DYC
manoeuvres at a forward speed of 10 m/s, as shown in
Figure 8, Figure 9 and Figure 10 respectively. The controller tracking errors, which are based on equation
(45) for the lateral position and the yaw angle
responses, are summarized in Table 4. From Figure 10,
for the lowest-speed manoeuvres and with a high road
adhesion coefficient, there was not much difference
between the manoeuvre controllers; both controllers
gave a perfect response when following a given trajectory and maintaining the vehicle stability. It can be
seen that, for 4WS and 2WS with DYC manoeuvres,
the rear steering angle and the direct yaw moment are
almost unused, since the front steering can provide sufficient control ability. This may be partly because the
rear steering and DYC were not used in lower-speed
manoeuvres.
In these scenarios, of the three control manoeuvres,
the 2WS with DYC performed slightly better (in particular, the yaw angle and the yaw rate responses) followed by 4WS, and finally 2WS, for which the lateral
position and the yaw angle look almost identical. In
this situation, the figures show that the rear steering of
the 4WS manoeuvre is going in the opposite direction
from the front steering in order to stabilize the vehicle
along the trajectory while, for control under 2WS with
DYC, it is used with very little torque because the yaw
outputs were successful in tracking and following a
given trajectory closely. In the low-forward-speed scenario, both controllers were successfully implemented
for all manoeuvre controls because the roll dynamics
do not have much influence during low-speed manoeuvres. Furthermore, at low vehicle speeds, all
manipulated inputs are under the constraints of the
front steering angle, the rear steering angle or DYC.
Next, we simulated the motion of the vehicle at a
high forward speed (chosen as 25 m/s) and neglected
the road surface friction (which was chosen as dry concrete; m = 1). We evaluated the robustness values of
the controllers for the output response by comparing
the performances of 2WS, 4WS and 2WS with DYC
manoeuvres as shown in Figure 11, Figure 12 and
Figure 13 respectively. It can be seen clearly from these
figures that, for the model predictive controller, the trajectory tracking responses for the lateral position and
the yaw angle were similar for all control manoeuvres,
and it was possible to track and follow a given trajectory successfully. The lateral position responses were
12
10
25
Manoeuvre
control
2WS
4WS
2WS + DYC
2WS
4WS
2WS + DYC
LQC
MPC
Y
(m)
c
(rad)
Y
(m)
c_
(m)
0.0798
0.0768
0.0772
0.0882
0.0834
0.0826
0.0198
0.0165
0.0163
0.7645
0.8484
0.6242
0.0812
0.0810
0.0810
0.0994
0.0838
0.0908
0.0081
0.0058
0.0054
0.2146
0.0782
0.0524
LQC: linear quadratic control; MPC: model predictive control; 2WS: two-wheel steering; 4WS; four-wheel steering; DYC: direct yaw moment
control.
13
similar for LQC, but it can be seen that LQC did not
perform well in terms of the yaw angle and the yaw rate
tracking responses. This shows that LQC is not suitable
for control implementation in multi-variable systems.
Moreover, Figures 12 and 13 illustrate that, for a
high forward speed of the vehicle, the manoeuvre
response was much better for 4WS and for 2WS with
DYC than for 2WS; the rear steering and DYC were
fully utilized. We can therefore conclude that, for 4WS,
the rear wheels helped the vehicle to steer by improving
its handling at a high speed and decreasing the turning
radius at a low speed. In 2WS vehicles, the rear set of
wheels are always directed forwards and do not play an
active role in controlling the steering. To illustrate our
14
15
Figure 16. Vehicle manoeuvre via 2WS with DYC at 20 m/s with m = 0.3.
Ref: reference; MPC: model predictive control; LQC: linear quadratic control.
16
20
Manoeuvre
control
LQC
2WS
4WS
2WS + DYC
Y
(m)
c
(rad)
Y
(m)
c
(rad)
0.8424
0.1048
0.1487
0.5654
0.0676
0.0986
0.5876
0.0954
0.1394
0.3014
0.0184
0.0268
vx = 25 m/s, m = 1
vx = 20 m/s, m = 0.3
MPC
MPC + FF
LQC + FF
R1 = 0.1
Q11 = 4.25
Q22 = 1.5
kff1 = 2.45
kff2 = 1.25
R1 = 0.1
Q11 = 3.85
Q22 = 1.25
kff1 = 1.95
kff2 = 0.75
Rlq = 5
Qlq1 = 18.5
Qlq2 = 3.5
Kf = 1.25
Ks = 1.45
Rlq = 5
Qlq1 = 12.5
Qlq2 = 2.8
Kf = 0.95
Ks = 1.15
Figure 17. Vehicle tracking errors for a manoeuvre via 2WS at 25 m/s with m = 1.
Ref: reference; MPC: model predictive control; FF: feedforward; LQC: linear quadratic control.
17
Figure 18. Vehicle tracking errors for a manoeuvre via 2WS at 20 m/s with m = 0.3.
Ref: reference; MPC: model predictive control; FF: feedforward; LQC: linear quadratic control.
Conclusion
This paper presented a comprehensive study of MPC
and LQC of an autonomous vehicle in path-following
control. The study focused on different control
18
10. Nagai M, Shino M and Gao F. Study on integrated control of active front steer angle and direct yaw moment.
JSAE Rev 2002; 23(3): 309315.
11. Falcone P, Tseng HE, Borrelli F et al. MPC-based yaw
and lateral stabilisation via active front steering and braking. Veh System Dynamics 2008; 46(1): 611628.
12. Keen SD and Cole DJ. Steering control using model predictive control and multiple internal models. In: 8th international symposium on advanced vehicle control, Taipei,
Republic of China, 2024 August 2006, pp. 16. Tokyo:
JSAE.
13. Manfred P and Johannes E. Driver models in automobile
dynamics application. Veh System Dynamics 2007; 45(7
8): 699741.
14. Adireddy G and Shim T. MPC based integrated chassis
control to enhance vehicle handling considering roll stability. In: ASME 2011 dynamic systems and control conference and Bath/ASME symposium on fluid power and
motion control, Arlington, Virginia, USA, 31 October2
November 2011, Vol 2, paper DSCC2011-6159, pp. 877
884. New York: ASME.
15. Anwar S. Yaw stability control of an automotive vehicle
via generalized predictive algorithm. In: 2006 American
control conference, Portland, Oregon, USA, 810 June
2005, pp. 435440. New York: IEEE.
16. March C and Shim T. Integrated control of suspension
and front steering to enhance vehicle handling. Proc
IMechE Part D: J Automobile Engineering 2007; 221(4):
377391.
17. Tanelli M, Vecchio C, Corno M et al. Traction control
for ride-by-wire sport motorcycles: a second order sliding
mode approach. IEEE Trans Ind Electron 2009; 56(9):
33473356.
18. Canale M, Fagiano L, Milanese M and Borodani P.
Robust vehicle yaw control using active differential and
internal model control techniques. In: 2006 American
control conference, Minneapolis, Minnesota, USA, 1416
June 2006, pp. 16. New York: IEEE.
19. Conde EC, Carbajal FB, Gonzaa lez AV and Bracamontes RC. Robust control of active vehicle suspension
systems using sliding modes and differential flatness with
MATLAB. In: K Perutka (ed) MATLAB for engineers
applications in control, electrical engineering, IT and
robotics. Rijeka: InTech, 2011, ch 18.
20. Wang J, Wilson DA, Xu W and Crolla DA. Integrated
vehicle ride and steady-state handling control via active
suspensions. Int J Veh Des 2006; 2(3): 306327.
21. Lee JH and Yoo WS. Predictive control of a vehicle trajectory using a coupled vector with vehicle velocity and
sideslip angle. Int J Automot Technol 2009; 10(2): 211
217.
22. Park JM, Kim DW, Yoon YS et al. Obstacles avoidance
of autonomous vehicle based on model predictive control.
Proc IMechE Part D: J Automobile Engineering 2009;
223(12): 14991516.
23. Falcone P, Borrelli F, Asgari J et al. Predictive active
steering control for autonomous vehicle systems. IEEE
Trans Control System Technol 2007; 15(3): 566580.
24. Nam K, Oh S, Fujimoto H and Hori Y. Robust yaw stability control for electric vehicles based on active front
steering control through a steer-by-wire system. Int J
Automot Technol 2012; 13(7): 11691176.
25. Bianchi D, Borri A, Di Benedetto MD et al. Adaptive
integrated vehicle control using active front steering and
26.
27.
28.
29.
30.
31.
32.
33.
34.
35.
36.
37.
38.
39.
40.
41.
42.
19
Appendix 1
Notation
bf
bw
Cf, Cr
et
ec
ex
ey
Fx, Fy
Fz
g
h
huf, hur
Hp, Hc
Ixx
Ixz
Izz
J
Jb
kff
kss
kf
l
lf, lr
m
Mf, Mr
Mz
n
Q, R
ri
rw
Rw
s
tw
T
Tb
20
Ts
Y
u
vx, vy
x, y, z
af, ar
b
df, dr
Du
DMz
Ddf, Ddr
m
c
f
c_
f_
vw
()f, ()r
Abbreviations
DoF
DYC
FF
LQC
MPC
QP
2WS
4WS
degree of freedom
direct yaw moment control
feedforward
linear quadratic control
model predictive control
quadratic program
two-wheel steering
four-wheel steering