Design, Validation and Comparison of Path Following Controllers for Autonomous Vehicles

As one of the core issues of autonomous vehicles, vehicle motion control directly affects vehicle safety and user experience. Therefore, it is expected to design a simple, reliable, and robust path following the controller that can handle complex situations. To deal with the longitudinal motion control problem, a speed tracking controller based on sliding mode control with nonlinear conditional integrator is proposed, and its stability is proved by the Lyapunov theory. Then, a linear parameter varying model predictive control (LPV-MPC) based lateral controller is formulated that the optimization problem is solved by CVXGEN. The nonlinear active disturbance rejection control (ADRC) method is applied to the second lateral controller that is easy to be implemented and robust to parametric uncertainties and disturbances, and the pure pursuit algorithm serves as a benchmark. Simulation results in different scenarios demonstrate the effectiveness of the proposed control schemes, and a comparison is made to highlight the advantages and drawbacks. It can be concluded that the LPV-MPC has some trouble to handle uncertainties while the nonlinear ADRC performs slight worse tracking but has strong robustness. With the parallel development of the control theory and computing power, robust MPC may be the future direction.


Introduction
Autonomous driving technology has become a research and development hotspot recently, since it has great potential to improve active safety, alleviate traffic congestion, and reduce energy consumption [1,2]. It was reported that the driver's mistakes contribute entirely or partially to nearly 90% of road accidents [3]. The autonomous system is more reliable and faster to react than human drivers, so it can handle critical scenarios that human drivers find challenging or lack the ability to navigate, such as emergency obstacle avoidance [4]. On the other hand, under the perspective of networked control, the platooning of autonomous vehicles provides an effective way to increase traffic capacity and fuel efficiency [5]. Therefore, numerous contests of autonomous vehicles have been carried out to promote technological development, such the DARPA (Defense Advanced Research Projects Agency) Challenges in the USA [6] and the Intelligent Vehicle Future Challenges in China [7], etc. Simultaneously, the research of autonomous vehicles is booming and highly competitive in the industry. The Waymo and Cruise autonomous driving cars are typical commercial products that have attracted wide attention [8].
The key technologies of autonomous vehicles consist of environment perception, decision making, motion planning, and vehicle motion control, and the objective of vehicle motion control can be • A longitudinal speed controller based on sliding mode control with nonlinear conditional integrator is proposed to realize the longitudinal motion control of autonomous vehicle during the path following process. It is well known that sliding mode controllers suffer from chattering.
To solve this problem, we adopt the saturation function to replace the sign function, meanwhile, a nonlinear integral action is introduced to achieve zero steady-state error and improve the transient performance, which can also avoid integral divergence. Stability analysis is given to prove that the equilibrium point is globally asymptotically stable.

•
The lateral controllers based on LPV-MPC (Linear Parameter Varying Model Predictive Control), ADRC (Active Disturbance Rejection Control), and PPM (Pure Pursuit Method)are designed, respectively. First, because the MPC can exploit available preview information and handles constraints, an MPC lateral control-based strategy that considers the soft constraints of the sideslip angle of the steer wheel is formulated based on the error dynamics model, which adopts the CVXGEN [16] solver to improve computational efficiency. Second, the nonlinear ADRC is applied to develop the lateral controller due to the simple control structure and good robustness, which is also largely model independent. Finally, the pure pursuit method using the geometric model is provided as a benchmark.

•
Multiple simulations in different scenarios are conducted to validate the effectiveness and capability of the proposed longitudinal speed controller and lateral path following controllers. A comparison of the three mentioned lateral controllers is made to highlight the advantages and drawbacks of each approach in path following. Finally, the possible development direction in the future is given.
The rest of this paper is organized as follows: Section 2 introduces the state of the art. Section 3 presents the system model and the problem definition. Section 4 explains the design procedure for the longitudinal speed controller. Section 5 presents the lateral controllers design of LPV-MPC, ADRC, and PPM, respectively. Section 6 shows the results and analysis. Finally, the paper is concluded in Section 7.

Related Work
Extensive work has been done to vehicle motion control of autonomous vehicles. In this section, we provide a brief review of the state of the art. Vehicle motion control can be divided into longitudinal Sensors 2020, 20, 6052 3 of 23 control and lateral control. Further, lateral control methods can be divided into geometry based, kinematics based, and dynamics based.
The longitudinal control manipulates drive and brake actuators to guide the autonomous vehicle to track a desired speed profile. The main control methods can be roughly classified into three categories: (1) Model-free control. The system dynamics are regarded as a black-box, and the control commands are generated from tracking errors only, e.g., the proportional-integral-derivative (PID) design [17]. (2) Model-based feedback control. A discrete-time preview speed controller was developed considering future desired speed and road slope information, which holds the advantage of prediction and to reduce to computational load as well compared to MPC [18]. Gerdes et al. utilized a multiple-surface sliding mode control to realize speed and space control [19]. To improve tracking performance under model uncertainties and external disturbances, a time-varying parameter adaptive speed control algorithm is proposed [20]. (3) Model-based optimization. The model predictive control framework was applied in a 16-bit micro controller, which can exploit available preview information [21]. However, it may suffer from high computational load, especially for the nonlinear MPC. Improving the computational efficiency is a key issue for MPC application.
The lateral control manipulates the steering actuator to deal with the path following problem generally, and the direct yaw moment control can be used as an additional approach for distributed drive vehicles and vehicles equipped with differential braking. According to the difference of the system model, path tracking control methods can be roughly classified into three categories: (1) Geometry based. It used the geometric relationship between the vehicle and reference. Classical algorithms include the pure pursuit method and Stanley algorithm [17], which were used in the DARPA Challenge vehicle. Such methods are simple and work well in many situations, but may have trouble on tight corners and at high speed due to a lack of consideration for vehicle dynamics. (2) Kinematics based. It is usually assumed that the autonomous vehicle satisfies non-holonomic constraint, in other words, the side slip angle is assumed to be zero. Aiming at the path tracking problem of the non-holonomic mobile robot, the kinematics model is transformed into the chain type by state and input feedback transformation, and a smooth time-varying feedback control law was given [9]. (3) Dynamics based. In order to obtain higher precision under the conditions of high speed and large curvature, it is necessary to consider the vehicle dynamics in the control design. A nested PID steering control scheme was proposed that the outer loop is used to compute yaw rate reference based on lateral offset and then the inner loop tracks the desired yaw rate [22]. Xu et al. presented a preview steering control algorithm, which formulated the path tracking issue as an augmented optimal control problem with dynamic disturbance [23]. Tagne et al. analyzed and compared three lateral nonlinear adaptive controllers, including the higher order sliding mode controller, the immersion and invariance controller, and the passivity-based controller [24]. MPC has become a popular technique that enables the vehicle to act ahead of time and handle constraints more conveniently. Falcone et al. demonstrated the effectiveness of linear MPC-based steering controller with a speed up to 21 m/s on a slippery road [25], and proposed a control scheme by a combined use of breaking and steering [26]. The integration of path tracking, vehicle stabilization, and collision avoidance had been investigated by considering stability envelope and environmental envelope in state and output constraints of MPC [27,28]. To safely navigate highly dynamic scenarios, the nonlinear model predictive controller also had been designed and validated [29]. It should be noted that appropriate tradeoffs between model fidelity and computation should be solved with caution [30]. Hu et al. [31] proposed a robust H ∞ output-feedback control strategy considering the parametric uncertainties and external disturbances. For the similar purpose, a linear active disturbance rejection control scheme is proposed for lane keeping problem [32]. Compared to this work, the nonlinear active disturbance rejection is used in this paper to improve the transient performance.

Systems Description
In order to describe the motion of an autonomous vehicle, the system dynamics of path following is defined, as illustrated in Figure 1. A preview lateral model is utilized here, where p c is the preview control point and p d is the reference path point.

Systems Description
In order to describe the motion of an autonomous vehicle, the system dynamics of path following is defined, as illustrated in Figure 1. A preview lateral model is utilized here, where c p is the preview control point and d p is the reference path point. Figure 1. Schematic of path following system. OXY is the global coordinate system and oxy is the vehicle body-fixed local coordinate system.

Longitudinal Vehicle Dynamics
Considering a vehicle moving on an inclined road, a force balance along the vehicle longitudinal axis yields: where I ω is the wheel inertia, ij ω is the wheel angular velocity and the subscript represents the four wheel of the vehicle, xij F is the longitudinal tire force, R is the wheel rolling radius.

Lateral Vehicle Dynamics
The objective of lateral control design is to eliminate the path error while guaranteeing vehicle stability. As shown in Figure 1, it is desirable to both eliminate the lateral error e y and heading angle error e ϕ at the preview point by manipulating the control input steering angle f δ .
The preview lateral kinematics can be modeled as: where β is the sideslip angle, p l is the preview distance, κ is the path curvature.
The 2DOF vehicle dynamics model is used to design the lateral controller, which can be expressed as: Figure 1. Schematic of path following system. OXY is the global coordinate system and oxy is the vehicle body-fixed local coordinate system.

Longitudinal Vehicle Dynamics
Considering a vehicle moving on an inclined road, a force balance along the vehicle longitudinal axis yields: m( where m is the vehicle mass, v x and v y are the vehicle longitudinal and lateral velocities, γ is the vehicle yaw rate, F x is the total tire force along the vehicle longitudinal axis, F y f is the lateral tire force of the front steering wheel, δ f is the front wheel steering angle, F r is the rolling resistance force, F w is the aerodynamic force, and F g is the gravitational force component generated by road grade. The wheel dynamics can be expressed as the following equation: where I ω is the wheel inertia, ω ij is the wheel angular velocity and the subscript represents the four wheel of the vehicle, F xij is the longitudinal tire force, R is the wheel rolling radius.

Lateral Vehicle Dynamics
The objective of lateral control design is to eliminate the path error while guaranteeing vehicle stability. As shown in Figure 1, it is desirable to both eliminate the lateral error y e and heading angle error ϕ e at the preview point by manipulating the control input steering angle δ f .
The preview lateral kinematics can be modeled as: .
where β is the sideslip angle, l p is the preview distance, κ is the path curvature. The 2DOF vehicle dynamics model is used to design the lateral controller, which can be expressed as: where C α f and C αr denote the cornering stiffness of the single front tire and rear tire, I z is the yaw moment of inertia, l f and l r are the distance from the front axle and rear axle to the center of gravity, respectively. The combined dynamics (3) and (4) can be written in the state space form, with the states x = y e ϕ e β γ T ∈ R 4 , the control input u = δ f ∈ R, the system outputs y = y e ϕ e T ∈ R 2 , and the measurable external disturbance w = κ(t) ∈ R: in which:

Longitudinal Speed Controller Design
The objective of longitudinal speed control is to track the desired speed profile accurately and smoothly, by manipulating the motor and electro-hydraulic brake system (EHB) in this paper. To improve the robustness to parametric uncertainties and provide disturbance rejection, a speed tracking controller via sliding mode control with nonlinear conditional integrator is developed. The control framework is shown in Figure 2.
Sensors 2020, 20, x FOR PEER REVIEW 5 of 24 where f C α and r C α denote the cornering stiffness of the single front tire and rear tire, z I is the yaw moment of inertia, f l and r l are the distance from the front axle and rear axle to the center of gravity, respectively. The combined dynamics (3) and (4) in which:

Longitudinal Speed Controller Design
The objective of longitudinal speed control is to track the desired speed profile accurately and smoothly, by manipulating the motor and electro-hydraulic brake system (EHB) in this paper. To improve the robustness to parametric uncertainties and provide disturbance rejection, a speed tracking controller via sliding mode control with nonlinear conditional integrator is developed. The control framework is shown in Figure 2.    From the control block diagram in Figure 3, it can be seen that the longitudinal speed controller consists of feedforward and feedback components. The feedforward term uses the desired acceleration profile to calculate the acceleration resistance, and compensates the road resistance according to vehicle operating conditions simultaneously. In the feedback control term, the sliding mode control method is adopted. Note that integral action is introduced in the sliding mode controller to ensure asymptotic tracking. Consider a single input and single output nonlinear n-order dynamic system: n n where y is the output, u is the input, w is the external disturbance, and multivariable function of both the states and external disturbances, as well as time. The objective here is to make y track reference signal ( ) 0 v t using u as the manipulative variable.
To provide the fastest tracking of ( ) 0 v t and get its derivatives, the TD in discrete-time implementation is written as: where h is the sampling period, ( ) fhan ⋅ is the time-optimal solution function, 0 r and 0 h are controller parameters.
is denoted as the total disturbance which is something needed to overcome in the context of feedback control. Introducing an additional state variable n n The dynamic system is now described as: where is always observable. Then, we can construct an extended state observer in the form of: Tracking Differentiator Nonlinear Feedback Combination

Feedforward from Reference Acceleration
According to the desired longitudinal acceleration a d at the reference point generated offline or provided by high-level planner, feedforward longitudinal force from reference acceleration F f f x can be calculated from Newton's second law as follows:

Drag Compensation
As shown in Equation (1), the road resistance concludes the resistance force from the vehicle's rolling F r , aerodynamic force F w , road grade F g , and the longitudinal component from the front axle turning F t . The expression of each resistance is given as follows: where f is the rolling resistance coefficient, C D is the air resistance coefficient, A is the frontal area of the vehicle, θ g is the road grade measured or estimated, a y is the lateral acceleration. The calculation of F t uses a steady state assumption and assumes that the front lateral force is proportional to the front static vertical load. Then, the drag compensation is obtained from: The total feedforward longitudinal torque is expressed as: Sensors 2020, 20, 6052 7 of 23

Feedback of Speed Controller
Robust asymptotic tracking can be achieved by the sliding mode control, therefore, it is applied here. To simplify the longitudinal dynamic model, assuming that the lateral velocity is zero, then we can get: m Using the pure rolling assumption that ω ij = v xij /R, the wheel dynamics in Equation (2) can be rewritten as: Combining Equations (10) and (11): where T is total control input torque, and Then, the tracking problem can be turned into a stabilization problem. Considering the resistance estimation error term, the stabilization system can be expressed as follows by combining Equations (6)-(10): where ∆(·) is the bounded resistance estimation error, and it is considered that slew rate is small. It is typical to choose the sliding surface as s = v e for a first order system, the sliding mode control law can be expressed as: with sufficiently large control gain k p , ensures that s . s ≤ −p 0 |s| < 0, for all s 0. While ideal sliding mode control achieves zero steady-state error, it is well known that, in practices, sliding mode controllers suffer from chattering due to switch delays and un-modeled dynamics. To eliminate chattering, we use the saturation function sat(·) to replace the sign function sgn(·), but it can guarantee only ultimate boundness with respect to a compact set, which can be made arbitrarily small by decreasing the thickness ε of boundary layer. However, a too small value of ε will again induce chattering due to non-ideal effects: where sat(·) is defined as: Zero steady-state error can be achieved by including integral action in the controller. This was done by Khalil [33] by augmenting the system with an integrator driven by the tracking error: The sliding surface is taken as: where the positive constant k 0 is chosen such that the system dynamics on sliding surface is controlled by Sensors 2020, 20, 6052 8 of 23 In this paper, the linear integrator is replaced by a nonlinear conditional integrator to avoid integral divergence and improve the transient performance: At the actuator level, the electric brake is used for slight braking case to improve response speed and control accuracy, and the hydraulic brake compensation is used for heavy braking case.

Stability Analysis
To analyze the stability performance of the sliding mode controller with the conditional integrator, it is carried out from two aspects of inside the boundary layer and outside the boundary layer.
Substituting Equation (15) into Equation (13), we can have: The closed-loop system has a unique equilibrium point (v e , σ) at 0, ε Selecting a Lyapunov candidate function: where Differentiating the left and right sides of Equation (20), it can be expressed as: .
Substituting v e = s − k 0 σ = s − k 0 σ into Equation (16), then the derivative of the Lyapunov function candidate can be rewritten as follows: Define a function f (x) = , i j = f l, f r, rl, rr, when the continuous Lipschitz continuity condition is satisfied, it can be obtained that: where L is the Lipschitz constant.
Therefore, the equilibrium point is globally asymptotically stable if the control parameters satisfy the following equation:

Outside the Boundary Layer
Substituting Equation (15) into Equation (13), the control law outside the boundary layer can be expressed as: It can be seen that the feedback control input converges to −k p sgn(s), the value of . σ converges to zero, and σ becomes εsgn(s). Thus, the controller can prevent integral action from divergence. Furthermore, when . v d sgn(s) > 0 is satisfied, it reaches the set {|s| ≤ ε} in finite time and remains inside thereafter.

Lateral Path Following Controllers Design
To obtain a simple, reliable, and robust path following controller that can handle complex situations, three lateral control schemes are proposed and compared. First, a LPV-MPC lateral control-based strategy is designed due to its ability of preview and handles constraints. Second, considering the simple control structure and good robustness, the nonlinear ADRC is applied to develop the second lateral controller. The third controller is based on the pure pursuit method, which is provided as a benchmark.

LPV-MPC Controller
Despite nonlinear MPC is attractive because of its ability to capture the nonlinearity of vehicle dynamics, the model complexity limited real-time implementation. Here, a LPV-MPC control law is designed.

Vehicle Model Discretization and Augmentation
The continuous vehicle model Equation (5) is discretized at each time step with a zero-order hold approximation that assumes constant continuous inputs over the duration of each discrete time step. The resulting discretized vehicle model is: where A k = I n + A t T s , B k = B t T s , D k = D t T s , C k = C t , T s is the sampling time. To eliminate the steady-state error, we change the control input u(k) to the rate of change of the input ∆u(k) = u(k) − u(k − 1) that can achieve the steady-state performance like an integral action, and augment the state vector as ξ(k) = x(k) u(k − 1) w(k − 1) T . Thus, the augmented system model becomes: in which: , C = C k 0 0 .

MPC Problem Formulation
Assuming that the current moment is k, the signals ξ(k + j|k ), ∆u(k + j|k ), and y(k + j|k ) represent the future value of the states, inputs, and outputs respectively. Considering the prediction based on the discrete state space model (28), the predict states can be obtained by iteration: where N p is the predict horizon, N c is the control horizon, and N c ≤ N p that means ∆u k + j k = 0 when j ≥ N c . Then, the predicted outputs can be expressed as follows: To reduce the notational complexity, the predicted outputs can be expressed as: in which: Sensors 2020, 20, 6052

of 23
The objective of the lateral controller is to track the desired path accurately and smoothly. Therefore, define the cost function as: where weight matrix Q is symmetric semi-positive definite, R is symmetric positive definite. Substituting Equation (31) into Equation (32), the cost function can be rewritten as: where E(k) = Φξ(k), and E T (k)QE(k) is constant, then the cost function is expressed as: where hessian matrix H = 2 Θ T QΘ + R , and gradient matrix g = 2Θ T QE(k).
Considering the constraint u min ≤ u(k) ≤ u max on the steering angle, the control input sequence U(k) and control increment sequence ∆U(k) satisfy the equation: in which: Considering the constraint ∆u min ≤ ∆u(k) ≤ ∆u max on steering angle increment, we can have: Considering the outputs constraint y min ≤ y ≤ y max , the predicted output sequence satisfies: Considering the states soft constraint of slip angle of front axle α f min − ς ≤ α f ≤ α f max + ς, the constraint is stated as: in which: Sensors 2020, 20, 6052

of 23
Combining Equations (35)-(38), the constraints of control increment sequence ∆U(k) can be written as: where U max , U min , ∆U max , ∆U min ∈ R Nc×1 that consist of N c piece of u max ,u min ,∆u max ,∆u min , respectively, similarly, Y max , Y min ∈ R Np×2 that consist of N p piece of y max ,y min , respectively. The final optimization problem takes the form: where the hessian matrix augmented as H = , the gradient matrix augmented as g = 2Θ T QE(k) 0 , ς is the slack variable, and ρ is the weight of slack variable.

Quadratic Program Solver
For the quadratic program representable problem as shown in Equation (40), CVXGEN provides a custom, high-speed solver that is library-free C code, which make an online solution as fast as possible. The optimization resolves each time step, as is standard with MPC, and the first element ∆u * (k|k) of optimal solution is applied to the system, and the feedback control law at time k is finally obtained: u(k|k) = u(k − 1) + ∆u * (k|k). (41)

ADRC Controller
Since active disturbance rejection control has strong robustness to system uncertainties and external disturbances, and can be implemented easily, so the nonlinear ADRC is applied to design the lateral controller in this paper. The ADRC is evolved from proportional-integral-derivative (PID) and it inherits the core idea of PID that makes it such a success: the error driven, rather than model-based [15].

ADRC Theoretical Basis
As shown in Figure 3, the nonlinear ADRC consists of three components: the tracking differentiator (TD), extended state observer (ESO), and nonlinear feedback combination (NFC). The TD provides the fastest tracking of the input signal and its derivative, and also arranges the transition process; the ESO considers the total disturbance as a new state variable and gives its estimation; the nonlinear feedback provides surprisingly better results than linear feedback, which play an important role in the ADRC framework.
Consider a single input and single output nonlinear n-order dynamic system: x, . . . , x (n−1) , w, t) + bu where y is the output, u is the input, w is the external disturbance, and f (x, . x, . . . , x (n−1) , w, t) is a multivariable function of both the states and external disturbances, as well as time. The objective here is to make y track reference signal v 0 (t) using u as the manipulative variable.
To provide the fastest tracking of v 0 (t) and get its derivatives, the TD in discrete-time implementation is written as: where h is the sampling period, f han(·) is the time-optimal solution function, r 0 and h 0 are controller parameters.
x, . . . , x (n−1) , w, t) is denoted as the total disturbance which is something needed to overcome in the context of feedback control. Introducing an additional state variable x n+1 = f (x, . x, . . . , x (n−1) , w, t), and let .
It should be pointed out that the controller coefficients are not dependent on the mathematical model of the plant, thus making ADRC largely model independent.

Application of ADRC
For the ADRC method, it is not suitable to process the single input multiple output coupling problem. Therefore, we only consider the lateral error stabilization in the ADRC scheme design. According to the lateral vehicle dynamics Equation (5), we can have: . . where: Rewrite the equation as the state space form: where , u = δ f . The ESO for lateral controller is designed as: . (50) The control law using nonlinear feedback combination can be expressed as: (51)

Pure Pursuit Controller
The pure pursuit method (PPM) is used as benchmark, shown in Figure 4. Its basic principle is to make the central control point of the rear axle reach the target point (g x , g y ) along an arc by controlling the steering radius of an autonomous vehicle.  Based on the simple geometric bicycle model of an Ackerman steered vehicle, the pure pursuit control law is given as: Based on the simple geometric bicycle model of an Ackerman steered vehicle, the pure pursuit control law is given as: where α is the angle between the vehicle heading vector and the look-ahead vector, l is the wheel base, and l d is the look-ahead distance.

Results and Discussion
In order to evaluate and compare the performance of the proposed path following controllers, a series of simulation experiments have been conducted. The main parameters of the autonomous vehicle are given as Table 1 which are taken from an actual prototype vehicle.

Case A: Speed Tracking
To validate the effectiveness of the proposed longitudinal speed tracking controller, stair step and sinusoidal tests have been carried out respectively, and simulation results are shown in Figures 5  and 6. In the stair step case, we compared the improved sliding mode control with the basic sliding mode control to verify the performance improvement. As shown in Figure 5b, the speed error of basic sliding mode control has an obvious chattering effect near zero, which would cause a drastic change in the control input due to the discontinuous sign function. The improved sliding mode control shows a smooth action. It can be seen that the steady state error is almost zero and the overshoot is small. Meanwhile, the mean rise time is about 1.327 s. In the sinusoidal condition, the transient performance of the improved sliding mode speed controller is good. Therefore, the proposed speed tracking controller can provide an excellent performance for longitudinal speed control during the process of path following.

Case B: Skid Pad Test
To illustrate the steady state characteristics of the proposed lateral controllers for autonomous vehicles, the skid pad test was chosen. As shown as Figure 7a, it consists of two circular paths that intersect at a tangent point. Meanwhile, it includes a point with discontinuous curvature where vehicles transition from one circle to another, which can provide insight into robustness to path curvature. Figure 7 demonstrates the responses of the designed lateral controllers. It can be seen that the steady state lateral error of the nonlinear ADRC controller is nearly zero and the steady state lateral error of LPV-MPC is about 0.0254 m, while the pure pursuit method-based controller suffers from higher steady state error. Besides, both the nonlinear ADRC and PPM controllers suffer from higher overshoot, in this case due to discontinuous curvature at the tangent point.

Case B: Skid Pad Test
To illustrate the steady state characteristics of the proposed lateral controllers for autonomous vehicles, the skid pad test was chosen. As shown as Figure 7a, it consists of two circular paths that intersect at a tangent point. Meanwhile, it includes a point with discontinuous curvature where vehicles transition from one circle to another, which can provide insight into robustness to path curvature.   Figure 7 demonstrates the responses of the designed lateral controllers. It can be seen that the steady state lateral error of the nonlinear ADRC controller is nearly zero and the steady state lateral error of LPV-MPC is about 0.0254 m, while the pure pursuit method-based controller suffers from higher steady state error. Besides, both the nonlinear ADRC and PPM controllers suffer from higher overshoot, in this case due to discontinuous curvature at the tangent point.

Constant 5 m/s with the Given Path
In this case, the autonomous vehicle was set to pass through the test area at a constant longitudinal speed of 5 m/s, and the corresponding maximum lateral acceleration is about 1.2 m/s 2 .
The control results of the proposed lateral controllers are shown in Figure 9, based on which the control accuracy is then compared. The nonlinear ADRC and PPM controllers achieve almost the similar tracking accuracy in lateral error, while the LPV-MPC had an excellent performance that the maximum lateral error is 0.0061 m. The heading error of the LPV-MPC controller is the smallest, followed by the nonlinear ADRC and PPM controllers. As shown in Figure 9d, using the CVXGEN solver and computer with Intel i7-4770 CPU, the mean computation time of LPV-MPC is about 0.0012 s when predicting 20 steps that the sampling time is 0.02 s, while the others are more computationally efficient than the LPV-MPC controller.

Constant 10 m/s with the Given Path
The desired longitudinal speed is set to 10 m/s in this case, and the corresponding maximum lateral acceleration is about 4 m/s 2 so that the tires are still in the linear zone.
The responses are presented in Figure 10. Similar to the case of 5 m/s, the LPV-MPC controller has the best transient performance, but the lateral error increases as the vehicle speed increases that the PPM controller has the same feature. It should be noted here that the lateral error of the nonlinear ADRC controller does not change significantly when the vehicle speed increases. This shows the robustness of the nonlinear ADRC controller to the uncertainties of model parameters. similar tracking accuracy in lateral error, while the LPV-MPC had an excellent performance that the maximum lateral error is 0.0061 m. The heading error of the LPV-MPC controller is the smallest, followed by the nonlinear ADRC and PPM controllers. As shown in Figure 9d, using the CVXGEN solver and computer with Intel i7-4770 CPU, the mean computation time of LPV-MPC is about 0.0012 s when predicting 20 steps that the sampling time is 0.02 s, while the others are more computationally efficient than the LPV-MPC controller. The desired longitudinal speed is set to 10 m/s in this case, and the corresponding maximum lateral acceleration is about 4 m/s 2 so that the tires are still in the linear zone.
The responses are presented in Figure 10. Similar to the case of 5 m/s, the LPV-MPC controller has the best transient performance, but the lateral error increases as the vehicle speed increases that the PPM controller has the same feature. It should be noted here that the lateral error of the nonlinear ADRC controller does not change significantly when the vehicle speed increases. This shows the robustness of the nonlinear ADRC controller to the uncertainties of model parameters. The desired longitudinal speed is set to 15 m/s in this case, and the corresponding maximum lateral acceleration is about 8 m/s 2 so that the tires show highly nonlinear characteristic.
The simulation results are shown in Figure 11. In this case, the performance of the PPM controller deteriorates significantly, with a maximum lateral error of 0.7258 m and obvious oscillation as well. The nonlinear ADRC controller still keeps stable to the vehicle speed even though large lateral acceleration, which is further verified that the nonlinear ADRC has strong robustness to parametric uncertainties. However, the transient performance of the LPV-MPC controller is worse than the nonlinear ADRC because the proposed LPV-MPC controller adopted a linear model and the actual vehicle dynamics is more nonlinear. The mean calculation time of the LPV-MPC controller is basically the same in these three double lane change tests.

Comprehensive Evaluation
As shown in Table 2, the maximum and root mean square values of lateral displacement error and heading angle error in the double lane change scenario are given, which provides a perspective of comparative analysis for the proposed path following schemes. When the constant test speed is no more than 10 m/s, the MPC has satisfactory control performance that the maximum lateral errors are 0.0061 m and 0.0372 m in test 1 and 4 respectively, far less than the nonlinear ADRC and PPM methods. However, the nonlinear ADRC shows the best performance in path following and the lateral error of MPC increases significantly due to the strong nonlinearity of tires in 15 m/s double lane change tests, while the PPM approach is not applicable because it only considers geometry but ignores vehicle dynamics. From the aspect of tracking performance, the nonlinear ADRC has strong robustness to speed variation. The heading angle error of each method and test is similar except for the PPM method at 15 m/s. The root mean square error indicates the transient performance during the tracking process, and the statistics show that there is the same trend as the maximum value. The desired longitudinal speed is set to 15 m/s in this case, and the corresponding maximum lateral acceleration is about 8 m/s 2 so that the tires show highly nonlinear characteristic.
The simulation results are shown in Figure 11. In this case, the performance of the PPM controller deteriorates significantly, with a maximum lateral error of 0.7258 m and obvious oscillation as well. The nonlinear ADRC controller still keeps stable to the vehicle speed even though large lateral acceleration, which is further verified that the nonlinear ADRC has strong robustness to parametric uncertainties. However, the transient performance of the LPV-MPC controller is worse than the nonlinear ADRC because the proposed LPV-MPC controller adopted a linear model and the actual vehicle dynamics is more nonlinear. The mean calculation time of the LPV-MPC controller is basically the same in these three double lane change tests.  The nonlinear ADRC controller still keeps stable to the vehicle speed even though large lateral acceleration, which is further verified that the nonlinear ADRC has strong robustness to parametric uncertainties. However, the transient performance of the LPV-MPC controller is worse than the nonlinear ADRC because the proposed LPV-MPC controller adopted a linear model and the actual vehicle dynamics is more nonlinear. The mean calculation time of the LPV-MPC controller is basically the same in these three double lane change tests.

Comprehensive Evaluation
As shown in Table 2, the maximum and root mean square values of lateral displacement error and heading angle error in the double lane change scenario are given, which provides a perspective of comparative analysis for the proposed path following schemes. When the constant test speed is no more than 10 m/s, the MPC has satisfactory control performance that the maximum lateral errors are 0.0061 m and 0.0372 m in test 1 and 4 respectively, far less than the nonlinear ADRC and PPM methods. However, the nonlinear ADRC shows the best performance in path following and the lateral error of MPC increases significantly due to the strong nonlinearity of tires in 15 m/s double lane change tests, while the PPM approach is not applicable because it only considers geometry but ignores vehicle dynamics. From the aspect of tracking performance, the nonlinear ADRC has strong robustness to speed variation. The heading angle error of each method and test is similar except for the PPM method at 15 m/s. The root mean square error indicates the transient performance during the tracking process, and the statistics show that there is the same trend as the maximum value.   Table 3 summarizes the advantages and drawbacks of each control strategy, it can be seen that none of the proposed controller is perfect and all methods can work well in some applications. MPC shows great potential in the vehicle control application with the development of theory and computing power. Nonlinear ADRC can provide strong robustness to uncertainties. The PPM can be used in parking maneuver and low speed vehicles such as sweepers. An intuitive evaluation chart is formed by scoring the KPI (Key Performance Indication) of the simulation results, as shown in Figure 12. The score is based on a 5-point scale, with higher scores indicating better performance in that area. Here, the key performance indications include four aspects: path tracking accuracy, robustness to parameters uncertainties, ability to deal with curvature discontinuity, and simplicity of practical application, which represent the four axis terms in Figure 12. It should be noted that scores are evaluated from a perspective of subjective and objective combination. As mentioned above, the LPV-MPC can achieve excellent lateral control precision at low lateral acceleration, and the control accuracy is acceptable even at high lateral acceleration. Due to the predictive ability of MPC, it can also handle the curvature discontinuity of the path. However, MPC is relatively complex to deploy to hardware and requires processing unit of higher computing power. Therefore, the LPV-MPC scores 5, 2, 5, 3 points in these four indicators, respectively. For the nonlinear ADRC, the lateral error and heading error are larger than MPC comprehensively, but it is more robust to the vehicle speed. Meanwhile, the control structure of ADRC is simple and it can be implemented in an embedded vehicle control unit, but the parameters need to be calibrated carefully. Path curvature discontinuity would cause a larger overshoot in the nonlinear ADRC controller. In general, the nonlinear ADRC scores 4, 5, 3, 4 points, respectively. The pure pursuit method only works well in the low speed case but it is the simplest in practical application. Then, the PPM scores 3, 2, 3, 5 points in these indexes, respectively.
driving slowly or parking error as speed increases An intuitive evaluation chart is formed by scoring the KPI (Key Performance Indication) of the simulation results, as shown in Figure 12. The score is based on a 5-point scale, with higher scores indicating better performance in that area. Here, the key performance indications include four aspects: path tracking accuracy, robustness to parameters uncertainties, ability to deal with curvature discontinuity, and simplicity of practical application, which represent the four axis terms in Figure  12. It should be noted that scores are evaluated from a perspective of subjective and objective combination. As mentioned above, the LPV-MPC can achieve excellent lateral control precision at low lateral acceleration, and the control accuracy is acceptable even at high lateral acceleration. Due to the predictive ability of MPC, it can also handle the curvature discontinuity of the path. However, MPC is relatively complex to deploy to hardware and requires processing unit of higher computing power. Therefore, the LPV-MPC scores 5, 2, 5, 3 points in these four indicators, respectively. For the nonlinear ADRC, the lateral error and heading error are larger than MPC comprehensively, but it is more robust to the vehicle speed. Meanwhile, the control structure of ADRC is simple and it can be implemented in an embedded vehicle control unit, but the parameters need to be calibrated carefully. Path curvature discontinuity would cause a larger overshoot in the nonlinear ADRC controller. In general, the nonlinear ADRC scores 4, 5, 3, 4 points, respectively. The pure pursuit method only works well in the low speed case but it is the simplest in practical application. Then, the PPM scores 3, 2, 3, 5 points in these indexes, respectively.  For model predictive control, further research is needed to build a good model that tradeoff between high fidelity and simple enough, and robust and stochastic MPC may be the future direction.

Conclusions
In this paper, three control schemes have been designed, verified, and compared for the path following application of autonomous vehicles. A longitudinal speed tracking controller is proposed based on sliding mode control with nonlinear conditional integrator, and stability analysis is also given. Considering the ability of preview and handling multi-constraints, the first lateral controller is based on the linear parameter varying model predictive control, which shows excellent tracking accuracy in the simulation tests. Though it requires real-time computations to solve the optimization problem, using the CVXGEN can achieve high efficiency to solve the QP problem. Nonlinear active disturbance rejection control is applied in the second lateral controller since ADRC is robust against the parametric uncertainties of vehicles. However, the comprehensive tracking performance is slightly worse than the MPC that was shown in comparison. The lateral controller via the pure pursuit method is used for a benchmark, which performs well in low speed case. The effectiveness and ability of the proposed schemes are validated by simulations. It should be noted that the LPV-MPC controller is relatively sensitive to the parametric uncertainties and the vehicle dynamics is highly nonlinear in large acceleration cases, therefore, the robust nonlinear model predictive control is our future research direction.