Minimum Time Approach to Emergency Collision Avoidance by Vehicle Handling Inverse Dynamics

Vehicle driving safety is the urgent key problem to be solved of automobile independent development while encountering emergency collision avoidance with high speed. And it is also the premise and one of the necessary conditions of vehicle active safety. A new technique of vehicle handling inverse dynamics which can evaluate the emergency collision avoidance performance is proposed. Based on optimal control theory, the steering angle input and the traction/brake force imposed by driver are the control variables; the minimum time required to complete the fitting biker line change is the control object. By using the improved direct multiple shooting method, the optimal control problem is converted into a nonlinear programming problem that is then solved by means of the sequential quadratic programming. The simulation results show that the proposed method can solve the vehicle minimum time maneuver problem, and can compare the maneuverability of two different vehicles that complete fitting biker line change with the minimum time and the correctness of the model is verified through real vehicle test.


Introduction
With the continuous development of the automobile industry, the number of car accidents grows accordingly, especially in traffic accidents involving pedestrians and cyclists.In some cases, car accidents can be seen as a collision between vehicles and obstacles.And then the emergency avoidance problem is proposed to avoid the accidents.Today, people pay more and more attention to the problem of high-speed emergency avoidance [1,2].When vehicles traveling at high speed meet obstacles, the driver will often choose the emergency brake parking or the bypass passing to avoid obstacles.Both the maneuvers require the driver to avoid obstacles in minimum time [3].
The research methods of vehicle handling dynamics usually include open-loop and closed-loop method.The two methods are called "forward problem" method of vehicle handling dynamics research.Open-loop research method does not consider the function of the driver's feedback and obtains vehicle response under the condition of mathematical model of vehicle and driver input.But closed-loop method obtains vehicle motion which follows the ideal path based on driver vehicle closed-loop control system model [4].In order to avoid building driver model which is a difficult and important problem for vehicle model, the method of vehicle handling inverse dynamics is proposed [5][6][7].The vehicle handling inverse dynamics can be reversed to obtain the driver's handling input based on the known model and vehicle motion (vehicle response).Then, the vehicle handling inverse dynamics can analyze what kind of handing is easily accepted by the driver with the safest and most rapid way [8][9][10].Google is developing self-driving technology that combines data collected by sensors installed on a car with existing mapping software to speed up, brake, and steer to a destination.First, the driver's handling input was obtained in the Google car.According to the handling input, self-drive mode controls the car.So Google car apply the principle of the vehicle handling inverse dynamics.The Mercedes Benz system of PRE-SAFE and BAS-PLUS are designed to help to avoid accidents.The effectiveness is a measure for the efficiency, with which a safety system succeeds in achieving this target within its range of operation in vehicle.The process is also the application of the vehicle handling inverse dynamics [11].
In emergency avoidance research, the vast majority of research focused on the shortest path in the process of emergency avoidance.Sundar and Shiller (1997) proposed a method producing the shortest path based on the Hamilton-Jacobi-Bellman equation in a cluttered environment.The method attributed the emergency avoidance problem of shortest distance to the optimal control problem of shortest time, generated the shortest path through the function of negative gradient, and achieved good results [12].Hattori et al. (2006) optimized the vehicle trajectory control for obstacle avoidance problem.A new control algorithm for obstacle avoidance within the shortest possible distance is proposed [2].Mukai et al. [13] transformed the problem of generating an optimal path without a collision between an automobile and obstacles as a mixed integer programming problem [2].However, the minimum time required to complete the emergency avoidance was very little to research.The maneuvers under the emergency avoidance require the driver to avoid obstacles in minimum time.So the minimum time approach to emergency collision avoidance is very important.In the paper, the inverse dynamics method was introduced to research the minimum time problem of the vehicle emergency collision avoidance.
Vehicle handling inverse dynamics can evaluate the driver's handling input by the specified handling performance and improve the performance of high-speed vehicle emergency avoidance.The handling performance of different vehicle can be compared with the most efficient way by the vehicle handling inverse dynamics [14][15][16].
In the paper, the optimal control theory is used in the field of vehicle handling inverse dynamics.In order to simplify the problem, the ideal driver handling inputs are considered without consideration of driver response lag and the forwardlooking role.

The Mathematical Model of Vehicle Steering Wheel Torque
Input.Assuming tire cornering properties in the linear range and considering rotational inertia of the steering system, the vehicle steering motion model is simplified as shown in Figure 1, which is a linear vehicle model with four degrees of freedom (DOF).The four degrees are lateral movement, horizontal pendulum movement, longitudinal motion, and steering system turning.A 4 DOF vehicle steering motion model is built as shown in Figure 1.The differential equations of motion are expressed as where V is the lateral velocity,  is the longitudinal velocity,   is the yaw rate,  is the total mass of vehicle,   is the vehicle moment of inertia around the vertical axis,   is the steering system moment of inertia,  1 is the returnable arm of front wheel,  is the state variables,   is the resistance coefficient of steering system,   is the composite stiffness of steering system,  is transmission ratio of steering system,  sw is the torque of steering wheel, ,  are the distance from the whole vehicle centroid to front and rear axle,  1 ,  2 are the comprehensive cornering stiffness of the former and rear wheels,  is the rotation angle of the former and rear wheels,   is the cornering force of the front wheel,   is the cornering force of the rear wheel,   is the driving/braking force of the front wheel (when   ≥ 0,   is driving force; when   < 0,   is braking force),   is the rear wheel driving/braking force,   is the rolling resistance (  = ;  is the rolling resistance coefficient), and   is the air resistance (  =   (3.6) 2 /21.15;   is the air resistance coefficient and  is the windward area).The vehicle runs on smooth surfaces, no slope resistance.In order to simplify the problem, the air resistance and rolling resistance are considered, not considering acceleration resistance.
If driving force/braking force is considered to impact the cornering force, it is where  is the friction coefficient of pavement,   is the vertical force of front wheel, and   is the vertical force of rear wheel.Take the longitudinal load transfer into consideration; it is where ℎ  is the height of vehicle mass center.
The ,  coordinates of the vehicle mass center in the  coordinate system have the following relations: (4)

The Optimal Control Model of Steering Wheel Torque
Input.Control variable () is the steering wheel torque  sw () and wheel driving force/braking force   (); the control goal is the minimum time through a given path.Therefore, the performance indicators of time are where  0 ,   are the initial time and terminal time.
According to (1), state equation can be expressed as In the equation, the state variables are Longitudinal velocity  is bounded by the vehicle maximum speed, lateral displacement is bounded by track around the border, the angle of the steering wheel  sw is bounded by driver's physiological limit, and control variable   is bounded by road adhesion.When the vehicle is under a front wheel driving, it is When the vehicle is under a braking force and the front and rear wheels are assumed in lock state, it is Control variable   is bounded by the maximum driving force which is provided by the power transmission system.
According to the connection between engine speed and the velocity of vehicles and the connection between the engine output torque and the driving force, the regulation between the maximum driving force and the velocity of vehicles can be obtained by the engine external characteristic curve.
According to the literature [17], the constraints preventing rollover in the course of the vehicle driving are where  is wheel tread and  is stability factor.All the constraints are shown by the following equation:

The Transformation of State Variables.
In the process of the vehicle tracking the desired trajectory, the ultimate elapsed time is difficult to determine.In order to solve this problem conveniently, the free terminal time can be transformed into the fixed terminal time for optimal control problem with the following ways.Longitudinal displacement variable  which is defined unitization is where  0 is the initial longitudinal displacement and   is the terminal longitudinal displacement.According to (4) and the time derivative of ( 12), the following equation can be obtained by taking a derivative with respect to time  in (12).Consider According to (13), performance index of ( 5) can be transformed into where  = (  −  0 )/( cos  − V sin ).Similarly, ( 6) is (1) The Original Problem Is Converted into a Fixed Terminal Time Mayer Problem [18].The state space expands into  + 1 dimensions; new state variables are introduced to satisfy the following two equations: The performance index of ( 14) can be translated into Therefore, as long as ( 16) is incorporated in to the system state equation ( 15) and ( 17) is merged into constraint equation (11), the original problem is translated into standard Mayer problem with given terminal.
(2) The Optimal Control Problem Is Transformed into Finite Dimensional Nonlinear Programming Problem.The optimization method used in the paper is one of the sequential quadratic programming method (SQP): Wilson-Han-Powell method.The method is based on the common Lagrange-Newton method.The basic theory of SQP converts the nonlinear programming problem to a series of quadratic programming problems, so it is called SQP.Specifically, the approximate solution   and approximate multiplier vector   were assumed to be known when the th iteration starts.In this way, the th quadratic programming subproblem   can be given, the new approximate solution  +1 can be obtained by solving the problem   , and the corresponding Lagrange multiplier vector  +1 is determined too.The abovementioned process is repeated until the approximate optimal solution of nonlinear programming problem is obtained.Assuming   =  +1 −   , then, getting  +1 by solving   can be converted to getting the   by solving the subproblem   .
Considering the common nonlinear constrained optimal control problem, min The procedures of sequential quadratic programming are given as follows.
(1) Give +1 is obtained by using quasi-Newton formula: take Then calculate  +1 by using BFGS correction formula: For the optimal control problem of time-varying system in this paper, it can be converted to the finite dimensional nonlinear programming problem by using the improved direct multiple shooting method.
(1) The interval  ∈ [0, 1] is divided into  uniform. + 1 nodes are obtained.(2) A set of vectors   ( = 0, 1, . . .,  − 1) are introduced as estimated values of control variable at the node.Control variable values between nodes are gotten by linear interpolation of two adjacent values.If the node place control variables   are known, each state variable can be gotten one by one by integration.Thus  +1 (1) can be obtained, and then performance index is gotten.Therefore, it can be argued that the solution of differential equation and performance indicators are only the function of each node control variable.
The gating finite dimensional nonlinear programming problem can be solved by using the sequential quadratic programming (using the fmincon function in the optimization toolbox of MATLAB).  is the transmission gear ratio,  0 is the main reducer gear ratio, and  is the wheel radius.

Numerical Simulation
The biker line performance of two vehicles is researched.The vehicle specific parameter values are shown in Table 1.
The steering wheel torque is controlled between ±8 N⋅m.The initial time is The size of biker line test road is shown in Figure 2. Parameter value in Figure 2 is  0 =  = 2,  = 3.Benchmarking width is  = 2.46 m.
In the actual driving process, driver's ideal target track should be as shown in Figure 3.It is a low order continuous smooth curve.Three-order curve of a continuous first derivative is gotten after three spline fits.Consider Parameter Model A and Model B are as in Table 1.
As is shown in Table 1, the curb weight of A vehicle was bigger than B vehicle.A vehicle was better than B vehicle in the configuration and space.
After 14 iterations, the minimum time in which model A passes the biker line after optimization is 15.7 s.After 16 iterations, the minimum time in which model B passes the biker line after optimization is 16.2 s.Therefore, the minimum  Figure 4 shows the simulation results about lateral displacements of two types of models.It can be seen that the two kinds of models' lateral displacement are almost coincidence.The motion law for vehicle between the road boundaries is that vehicles move almost in straight line.
Figure 5 shows the simulation results about steering wheel torque of two vehicles.It can be seen from the several steering wheel torque amplitudes that the steering wheel torque amplitude of vehicle A is larger than that of vehicle B.
Figure 6 shows the simulation results about the wheel driving force of two vehicles.It can be seen that the driving force decreases at first and then increases in the serpentine line performance process; it also can be seen that the vehicle A's driving force is larger than that of the vehicle B.
Figure 7 shows the two models' longitudinal velocity simulation results.It can be seen that in serpentine line performance process, Model A increases rapidly from 20 m/s to 30.7 m/s and Model B increases rapidly from 25 m/s to 29.2 m/s.Therefore, the acceleration performance of Model A is better than that of B.
When the vehicle travels at 25 m/s high speed initially, after 14 iterations, the minimum time in which Model A passes the biker line after optimization is 14.9 s.After 18 iterations, the minimum time in which model A passes the biker line after optimization is 15.2 s.Therefore, when the vehicle run at the fast speed, it drive through the serpentine in short time.But as the vehicle's speed increases, the driver's burden increases and the safety reduces.The driver has to reduce vehicle's speed to a certain level to ensure his safety before the vehicle passes the biker line.

Experimental Verification
In this paper, two types of off-road vehicles mentioned above are used to test vehicle handling stability.Real vehicle test is very dangerous in high speed.In order to consider the driver's safety, the method of pavement design point is taken in the test.
The test procedures are as follows.
(1) In the test site, stake position marker is designed as in Figure 5.
(2) Connect the test instruments; switch instruments power on in order towarm the instruments to normal operating temperature.
(3) The vehicle passes the test section with an initial speed of 72 km/h.Running over the marker is not allowed in the running process.At the same time, the time history curve of the measured variables (steering wheel angle and longitudinal velocity) is recorded by the computer.
(4) Repeat steps (3) process 12 times (the times of press the marker is not considered).Two vehicle types' experimental data are obtained by the same test methods above if the vehicle type is changed.
The test site is built as shown in Figure 8.The experimental procedures and protocols are built as shown in Figure 9.
12 groups of test time were, respectively, 17.8 s, 18.1 s, 17.9 s, 18.5 s, 18.8 s, 18.3 s, 17.9 s, 18.3 s, 18.2 s, 18.9 s, 19.0 s, and 18.8 s.Due to considering a lot of factors, such as driver's reaction time and road conditions, the experimental test time was generally longer than the time of optimal control.The mean and standard deviation were, respectively, 18.27 s and 0.3743.Comparison between the simulation value and the experimental value is shown in Figures 10 and 11.As shown in Figures 10 and 11, there are some errors between simulation value and experimental value, mainly because every driver's subjective feelings and driving skills is different.In addition, the test instrument also has some errors.But the change tendency of simulation value and experimental values is consistent.So the correctness of the optimal control model is proved.

Conclusion
In the field of automotive engineering, many researchers are focusing on the development of self-driving technologies.Self-driving vehicles promise to bring a number of benefits to society, including prevention of road accidents, optimal fuel usage, comfort, and convenience.Vehicle handling inverse dynamics is form of the self-driving technologies.The steering wheel torque can be obtained by the vehicle handling inverse dynamics and used to determine the vehicle steering problems in the emergency collision avoidance.So the vehicle handling inverse dynamics can promote the selfdriving vehicle development.
In this paper, minimum time approach to emergency collision avoidance is researched by the method of vehicle handling inverse dynamics.Firstly, the optimal control model of the vehicle emergency collision avoidance problem was established.And then the optimal control problem was changed into a nonlinear programming problem using the improved direct multiple shooting method.Finally, the transformed nonlinear programming problem was solved by using sequential quadratic programming method.The correctness of the optimal control model is verified by using real vehicle test.The results show that this method can successfully solve the minimum time problem of vehicle emergency

Figure 10 :
Figure 10: The steering wheel torque simulation results.
is the approximation of Hesse matrix of Lagrange function.The solution of above subproblem is   ; the   is used as the search direction of th iteration in the method of Wilson-Han-Powell.It is the descent direction of penalty function.
In formula (22), the penalty function (, ) is the precise penalty function of  1 ;   is a nonnegative series and satisfies the following condition:

Table 1 :
Two vehicles parameter list.