Robust PID Steering Control in Parameter Space for Highly Automated Driving

This paper is on the design of a parameter space based robust PID steering controller.This controller is used for automated steering in automated path following of a midsized sedan. Linear and nonlinear models of this midsized sedan are presented in the paper. Experimental results are used to validate the longitudinal and lateral dynamic models of this vehicle. This paper is on automated steering control and concentrates on the lateral direction of motion. The linear model is used to design a PID steering controller in parameter space that satisfies D-stability. The PID steering controller that is designed is used in a simulation study to illustrate the effectiveness of the proposed method. Simulation results for a circular trajectory and for a curved trajectory are presented and discussed in detail. This study is part of a larger research effort aimed at implementing highly automated driving in a midsized sedan.


Introduction
In recent years, intelligent vehicle systems and highly automated driving technologies have drawn interest among researchers.Many research efforts including, for example, the work reported in [1][2][3] have concentrated on semiautonomous and fully autonomous vehicles.Autonomous driving requires coordinated automation of the longitudinal and the lateral driving tasks of speed control and steering control, respectively.Desired path tracking of an autonomous vehicle requires the proper design and implementation of steering and speed controllers at the lower control level.This paper concentrates on automated steering control.
The basic automatic steering control algorithms found in the literature are based on PID (proportional-integralderivative) type controllers [4,5].In these designs, the lateral deviation of the vehicle at a preview distance is fed back for controlling the vehicle's lateral dynamics.In [6], a robust PIDD controller is designed for automatic bus steering control as a solution of a benchmark problem.The yaw rate is measured in addition to lateral deviation measurements and is fed back for improving the control system performance.For the same benchmark problem, a discrete time add-on disturbance observer design is realized in [7].Using the addon disturbance observer, the performance improvement is achieved without the need for yaw rate feedback.Another approach to automatic steering controller is to design nested PI and PID controllers [8].A PI steering controller that reduces yaw rate tracking error is used to improve the vehicle steering dynamics and a PID controller is employed to reject the lateral deviation from the desired path due to road curvature disturbances [8].
In this paper, the parameter space approach based PID controller design is applied to automatic steering control.The theoretical background about the parameter space approach and an example of road vehicle yaw stability control can be found in the references [9][10][11].The parameters exhibiting the International Journal of Vehicular Technology largest variation in automatic steering control are the vehicle mass, the vehicle speed, and the road friction coefficient.In this paper, the controller parameter space for the two free coefficients of a PID controller which are chosen as the proportional gain   and the derivative gain   is obtained considering -stability requirements.An overall solution region is calculated by intersecting the solution regions for exemplary points chosen from the boundary of the uncertain range of parameters.Robust PID coefficients satisfying stability are chosen from the overall calculated parameter space regions.The designed controller is applied to an experimentally validated nonlinear simulation model of a sedan used in autonomous vehicle tests by the authors.
The organisation of the rest of this paper is as follows.In Section 2, the linear vehicle model used in controller design and the experimental vehicle that it is based on are described.The nonlinear model of this experimental vehicle and model validation results are also presented in Section 2. In Section 3, the robust PID controller design is performed based on mapping -stability boundaries into the parameter space.The simulation results in Section 4 illustrate the effectiveness of the designed controller.The paper ends with conclusions and recommendations for future work in Section 5.

Vehicle Steering Model.
The vehicle steering behavior is modeled as single track model that also includes the dynamics of following the reference path as illustrated in Figure 1.The linear vehicle steering model is described in state-space form as where where m = / is the virtual mass, J = / is the virtual moment of inertia,  is the road friction coefficient,  is the vehicle mass,  is the moment of inertia,   and   are the cornering stiffnesses,   is the distance from the center  of gravity of the vehicle (CG) to the front axle, and   is the distance from the CG to the rear axle [7].The values of the parameters used in this paper are  = 2392 kgm

Experimental Vehicle.
The experimental vehicle is a Fiat Linea midsized sedan.Three Fiat Linea midsized sedans were used by the authors and their colleagues in lateral dynamics testing [12], semiautonomous driving in a platoon [2], and autonomous path following experiments [13], respectively.The authors, therefore, have considerable experimental experience with this vehicle.The current paper uses the third of these vehicles in [13].The steering controller designed in this paper will be tested on that vehicle which is shown in Figure 3.This is the drive-by-wire vehicle of İstanbul Okan University named Okanom [14].Throttle, brake, and steering actuation signals are provided by a dSpace microautobox general purpose electronic control unit which is also used for all the low level computations.Available signals on the vehicle CAN bus are read by this microautobox.A personal computer operating under Linux is used as an upper level  control system.This PC collects data from the GPS receiver, the IMU unit, the Lidar in front of the vehicle, and the IEEE 802.11p vehicle to vehicle (V2V) communication modem and communicates with the low level microautobox controller.
The GPS and the IMU signals are used in GPS/INS integration [15].The GPS position of the vehicle is periodically sent by the V2V system to a nearby road side unit (RSU).This information is used to track the vehicle position on a remote computer and on smartphones.The path to be followed is recorded as a list of successive GPS waypoints which form the desired path in Figure 1.

Nonlinear Vehicle Model.
The equations of motion for the longitudinal and the lateral dynamics of the nonlinear vehicle model are while the equation of motion around the yaw axis is where   and   are the longitudinal and the lateral tire forces. and  represent the front and rear tires.  ,   ,   ,   , and   are the longitudinal acceleration at the CG, the lateral acceleration at the CG, the longitudinal velocity at the CG, the lateral velocity at the CG, and the moment of inertia about the yaw axis, respectively.Note that for the front wheel steered vehicle considered in this paper, the rear wheel steering angle The resistive forces which affect the longitudinal dynamics of the vehicle are shown in Figure 4.The aerodynamic drag force  aero is given by where  is the effective frontal area of the vehicle,  is the mass density of air,   is the drag coefficient, and  is the velocity of the vehicle.The rolling resistance force   is determined as where   is the rolling resistance coefficient and  is the road inclination angle.The gravitational slope resistance force  ℎ is modeled as The internal combustion engine (ICE) is modeled using a static engine map that defines the relationship between the inputs of throttle position , the engine speed , and the output engine torque  ICE (, ).The engine torque output is transmitted to the wheels through the driveline as torque   according to where   is a static efficiency factor used to model mechanical losses and   is the transmission ratio.These parameters are used to model the transmission of the vehicle.
The forces and torques acting on the wheel are shown in Figure 5.The moment balance at the center of the wheel is given by where   is the moment of inertia of the wheel,  is the angular velocity of the th wheel,   is the braking torque on the th wheel applied through the brake system,   is the longitudinal tire force of the th wheel, and   is the effective wheel radius.The longitudinal velocities of the front and rear wheels can be determined as follows: where the tire slip angles are The longitudinal wheel slip ratio is defined as The Dugoff tire model is used for the calculations of the tire forces as where   and   are the longitudinal stiffness and the lateral cornering stiffness of the th wheel.The coefficients   are determined using [2] Model validation studies were performed using the data obtained from the experimental vehicle test runs.The measured steering wheel and vehicle velocity were used as inputs to the nonlinear vehicle model.The simulated outputs for vehicle velocity and yaw rate were compared with the obtained experimental data.A comparison result from a test run is shown in Figure 6.A -turn-like maneuver was applied to the vehicle.The nonlinear vehicle model results of the vehicle velocity and yaw rate were consistent with the obtained data from the experimental vehicle.In the test run shown in Figure 7, the experimental vehicle followed a velocity profile from the Grand Cooperative Driving Challenge [2].The steering wheel input was zero.It can be seen from Figure 7 that the velocity obtained from the nonlinear vehicle model coincides with the experimental test result closely.

Robust PID Steering Controller Design
Using the Parameter Space Approach

Mapping D-Stability Requirements into the Parameter
Space.Similar to the approach in [11], -stability requirements can be mapped into the parameter space.Consider the plant given by where () represents the numerator of the plant and () represents its denominator.The real and imaginary parts of the numerator and denominator can be defined as () =   () +   () and () =   () +   ().
The PID controlled closed loop system characteristic equation can be written as where  is the degree of the plant ().
The Hurwitz stability boundary crossed by a pair of complex conjugate roots is characterized by the following equations: Re [  ()] = 0, (18)

This is called the complex root boundary (CRB).
There may be a real root boundary such that a single real root crosses the boundary at frequency  = 0 as characterized by

This is called the real root boundary (RRB).
There may exist an infinite root boundary (IRB) which is characterized by a degree drop in the characteristic polynomial at  = ∞.This degree drop in the characteristic polynomial is characterized as CRB, RRB, and IRB solutions parameterized by frequency  can be plotted in the parameter plane of two free design parameters to show the Hurwitz stability regions of the given closed loop system.The free parameter pairs which provide Hurwitz stability can be chosen visually from the stable region of the parameter plane.
The aforementioned parameter space computation method to determine Hurwitz stability regions can be extended to specify relative stability regions such as stability.A closed loop system is -stable when the roots of the closed loop characteristic equation lie in the -stable region in the complex plane as depicted in Figure 8.The boundary  1 in Figure 8 can be mapped into the parameter space by using - instead of  in (17) in order to shift the stability boundary to  1 in the complex plane.Solving for two free parameters in (18) for CRB and (19) for RRB and then plotting results will result in the  1 boundary in the parameter space.For the  1 boundary, there is no IRB because  is never equal to infinity in the -shaped region.For mapping the  2 boundary, use   for  with constant  in (17) and parameterize  in (18) to obtain the CRB of  2 .No RRB and IRB solution exists because  is never equal to zero or infinity.Lastly, the  3 boundary maps into the parameter space by substituting  with   where  is constant and the map is parameterized over  in (17).This results in CRB for changing  and RRB for  = 0 ∘ .

International Journal of Vehicular Technology
Using the state-space form, the transfer function   from the steering angle   to the lateral deviation  is written as and the transfer function from the road curvature  ref to the lateral deviation  is described as These transfer functions are used in designing the robust PID controller for the automatic steering system.The control system structure is illustrated in Figure 9.
The robust PID controller is designed based on the parameter space approach.The -stability requirements are taken into consideration.The -stability boundaries (shown in Figure 8) are formed by assuming roots no closer than 0.5 to the imaginary axis and no further in magnitude than 2.7 from the imaginary axis ( = 0.5 and  = 2.7).A minimum damping ratio corresponding to  = 45 ∘ is determined as 0.707.
Two parameters of the PID controller are selected as free design parameters.In this paper, these free parameters are chosen as the proportional gain   and the derivative gain   of the PID controller.The integral gain   of the PID controller is determined as a fixed parameter by the designer.Here,   is selected as 5.
Figure 10 shows the solution region for the P1 vertex of the uncertainty box shown in Figure 2.  1 CRB and RRB,  2 CRB, and  3 CRB and RRB of the -stability bounds are depicted with different colors.The intersection of these bounds determines the boundary of the -stable region in the   -  plane.
The overall solution region which combines all the solutions for the vertices of the uncertainty box in Figure 2  as (15, 12.5) from the shaded area in Figure 11 which satisfies the design requirements for all operating points.

Simulation Study
The simulation studies are performed to test the effectiveness of the designed robust PID controller.In the first simulation, vehicle mass, vehicle velocity, and road friction coefficient are taken as 1500 kg, 15 m/s, and 1, respectively.These parameter values correspond to the point marked with  in the uncertainty box of Figure 2.
In the first simulation of Figure 12, the vehicle tries to follow a path consisting of a straight track of 150 m followed by a full turn in a circle of radius 100 m followed by a 150 m straight track.The vehicle velocity is kept constant at 15 m/s along the way.In the nonlinear vehicle model, a PI-based cruise control algorithm keeps the vehicle velocity constant.Also, the steering angle saturation is taken into consideration in the simulations.The front wheel steering angle   is limited to 40 degrees.The simulation results given in Figure 12 show the vehicle trajectory, the lateral deviation, the vehicle velocity, and the yaw rate.It is seen that the vehicle follows the desired trajectory successfully.The vehicle velocity is kept around 15 m/s by the cruise control algorithm and the vehicle yaw rate is at acceptable values.
In the second simulation, the vehicle tries to follow a curved path with different road curvature values.The tireroad friction coefficient alters between 1 and 0.5 to simulate different road conditions such as dry asphalt and slippery road surface.The vehicle tries to track a velocity profile which changes between 5 and 18 m/sec.The followed road curvature, the variable tire-road friction coefficient profile, the vehicle trajectory, the lateral deviation of the vehicle, the velocity profile followed, the vehicle velocity, and also the vehicle yaw rate change are shown in Figure 13.It is seen that the vehicle follows the given trajectory with very small lateral deviation and that the velocity profile is followed successfully by the PI-based cruise controller.The vehicle yaw rate is also at acceptable values.

Conclusions
A parameter space based robust PID steering controller design for automated steering was developed and tested in International Journal of Vehicular Technology a simulation environment in this paper.A validated model of a midsized sedan was used in the design and simulations.The simulation results showed the success of this controller in path following.This study is part of a larger research effort aimed at highly automated driving.The steering controller designed here will be implemented and used in the experimental vehicle Okanom presented in this paper.

Figure 4 :
Figure 4: The resistive forces acting on the longitudinal dynamics of the vehicle.

Figure 5 :
Figure 5: The forces and the torques acting on the wheel.

Figure 6 :
Figure 6: Comparison of test data and nonlinear vehicle simulation results for lateral dynamics.

Figure 7 :
Figure 7: Comparison of test data and nonlinear vehicle simulation results for longitudinal dynamics.

Figure 8 :
Figure 8: -stable region in the complex plane.

3. 2 .
Application to Automatic Steering Control.The vehicle steering dynamics state-space model corresponding to (1) can be expressed in standard form as ẋ =  + .