Path tracking with minimum time of vehicle handling inverse dynamics based on adaptive gauss pseudospectral method
Yongsheng Liu^{1} , Yingjie Liu^{2}
^{1, 2}School of MechanicalElectronic and Vehicle Engineering, Weifang University, Weifang, 261061, Shandong, China
^{2}Corresponding author
Journal of Measurements in Engineering, Vol. 7, Issue 4, 2019, p. 164182.
https://doi.org/10.21595/jme.2019.20875
Received 24 June 2019; received in revised form 17 September 2019; accepted 22 October 2019; published 31 December 2019
Vehicle driving safety is the urgent key problem to be solved by an independent automobile development project. And it is also the premise and one of the necessary conditions for active vehicle safety. A new technique for path tracking with minimum time of vehicle handling inverse dynamics is proposed in this paper. Based on a new optimal control method – Adaptive Gauss Pseudospectral Method (AGPM), the optimal control for path tracking with minimum time problem was converted into a nonlinear programming problem which met the boundary condition and a series of path constraints including path constraint, state constraint, control constraint. And then the problem was solved using the sequential quadratic programming (SQP). The simulation results showed that the proposed method was not sensitive to the initial value and the optimization efficiency was higher compared with indirect methods and traditional direct methods. When solving the problem of path tracking with minimum time as per this method, boundary constraints and path constraints were well satisfied. The algorithm was not only precise but it could also shorten the evaluation period of vehicle handling stability and could reduce the tremendous cost for real vehicle testing. So the maneuverability of two different vehicles that complete the pylon course slalom test road with minimum time can be evaluated objectively by utilizing the method. The model correctness is verified through a real vehicle test.
 The proposed algorithm (AGPM) is not sensitive to the initial value.
 The optimization efficiency is higher compared with indirect methods and traditional direct methods.
 The algorithm (AGPM) is precise and can shorten the evaluation period of vehicle handling stability.
 The proposed method can reduce the tremendous cost for real vehicle testing.
Keywords: path tracking, AGPM, inverse problem, minimum time.
1. Introduction
Driving a vehicle is a process that driver generates vehicle trajectories through detecting and recognizing obstacles on the road and then drives the vehicle along the planned trajectories. The driver maneuvers, and driving tasks are updated timely when the driving environment and the vehicle state are changing over time. But the driver modeling method is always a “bottleneck” problem in the drivercar closedloop system dynamics. As a result, the inverse vehicle handling dynamics which can solve the driver’s input based on known vehicle model and state of the vehicle motion (the vehicle response) is called the “inverse approach” of vehicle handling dynamics. Trajectory tracking control was one of the most advancing topics for the past decade [14].
Ever since the invention of automobiles, research in vehicle safety systems has been an ongoing study. Engineers and researchers have been trying to fully understand the dynamic behavior of vehicles as they are subjected to different driving conditions, with different drivers. They want to apply these findings to improve issues such as ride quality and vehicle stability and safety, and to develop innovative designs that will improve vehicle operation [5, 6].
The problem of path tracking with minimum time has been studied in the literatures. A brief review is presented in what follows.
Yang et al. [6] presented a theoretical expansion of a new intelligent algorithm called as the extended support vector data description (ESVDD) for the analysis and control of dynamic groups to realize macroscopic and microscopic behavior prediction in an automotive collision avoidance system. However, the algorithm’s effectiveness is ignored.
Fu et al. [7] proposed a path tracking controller for an autonomous vehicle, which aims at pushing it to the driving and handling limit. The limit dynamic performance of the autonomous vehicle was represented by the GG diagram, which indicated the acceleration capability of the autonomous vehicle. The simulation validation results demonstrated the effectiveness of the proposed controller. However, such important information as robustness data about the algorithm is ignored.
Krid et al. [8] presented a path tracking controller for a fast rover with independent front and rear steering. The controller was based on the dynamic model of a bicycle like vehicle which considered the lateral slippage of the wheels. The prediction model allowed the anticipation of future changes in set points in accordance with the dynamic constraints of the system. Experimental results showed a good control accuracy and appeared to be robust with respect to environmental and robot state changes. But there was a strong dependency on the precision of the model.
Amer et al. [9] presented a development and optimization of a proposed path tracking controller for an autonomous armored vehicle and developed a path tracking control based on an established Stanley controller for autonomous vehicles. The basic controller was modified and applied on a nonlinear, 7degreesoffreedom armored vehicle model, and consisted of various modules such as handling model, tire model, engine, and transmission model. But the proposed method bears heavier computing burden.
Guo et al. [10] presented a novel coordinated path following system (PFS) and direct yawmoment control (DYC) of autonomous electric vehicles via hierarchical control technique. Finally, the effectiveness of the proposed control system was validated by the simulation and experimental tests. But there was difficulty in rulemaking.
Memon et al. [11] presented a comprehensive architecture of an active collision avoidance system for an autonomous vehicle to deal with potential hazards on a straight road or a curved road. Meanwhile, the robustness about the algorithm is ignored in this process.
Setiawan et al. [12] presented a new type of fourwheel independent steering automatic guided vehicle (4WISAGV) for carrying heavy luggage and proposed a controller for the 4WISAGV to track reference trajectories. The results showed that the proposed controller could make the 4WISAGV track the trajectory with sharp edges and the circular trajectory very well.
Zou et al. [13] proposed a novel approach to the dynamic modeling and motion control of tracked vehicles undergoing skidsteering on horizontal, hard terrain, under nonholonomic constraints. Validated via a numerical example, the proposed controller was proven to be effective in controlling an unmanned tracked vehicle. However, the external disturbance was studied insufficiently.
Yu et al. [14] designed a novel controller to improve the pathtracking performance of articulated dump truck (ADT). The designed controller combined with a linear quadratic regulator (LQR) with genetic algorithm (GA) was used to control linear and angular velocities on the midpoint of the front frame. The results of simulation and experiment showed that the LQRGA controller had a better tracking performance than the existing methods under a low speed of 3 m/s. However, such important information as robustness data about the algorithm is ignored.
Wang et al. [15] described a control framework to address a typical vehicletovehicle encountering scenario of lane exchanging with two vehicles which traveled on contiguous lanes in the same direction and were maneuvered to exchange lanes of each other. A trajectory generating model for lanechanging maneuver was integrated into the drivervehicle system. While the roll condition performance of the vehicle should be discussed.
This paper aims to present a method which is based on the optimal control theory for path tracking problem in inverse vehicle handling dynamics. The method is used to calculate the optimal control input such as steering torque for a vehicle tracking the desired path with the minimum time without striking neighboring obstacles or departing the desired path almost. Focusing on the purpose, this paper presents a 4degreesoffreedom (DOF) vehicle model firstly. And also, we establish a simulation to verify the effectiveness of the proposed method and propose a comparative verification with another traditional method. After verifying the correctness of the numerical simulation by experiment, the conclusions are summarized and the future research directions are suggested.
2. Model of vehicle path tracking problem
2.1. Mathematical model of vehicle path tracking with minimum time problem
It is assumed that the longitudinal force acting on the front wheels is small, and the influence on the tire cornering characteristics affected by tangential ground force is ignored with tire cornering characteristics within the linear range. The 4DOF vehicle model is depicted in Fig. 1 [16].
Fig. 1. 4DOF vehicle model
In the statespace form, the formula is as follows:
The parameters and corresponding definitions are shown in Table 1.
The lateral forces of the front and rear tires are:
where ${k}_{2}$ is the synthesized stiffness of rear tires, $\mu $ is the friction coefficient.
Table 1. Parameter and definition
Parameter  Definition 
$v$  Lateral speed 
$u$  Longitudinal speed 
${\omega}_{r}$  Yaw rate of vehicle 
$m$  Vehicle mass 
${I}_{z}$  Moment of inertia around $z$ axis 
${k}_{w}$  Synthesized cornering stiffness 
${I}_{w}$  Moment of inertia of steering system 
$a$  Distances of front axle from center of gravity 
$b$  Distances of rear axle from center of gravity 
${k}_{1}$  Synthesized stiffness of front tire 
${k}_{2}$  Synthesized stiffness of rear tire 
$i$  Steering system transmission ratio 
${c}_{w}$  Drag coefficient 
${\xi}_{i}$  Front wheel aligning arm of force 
$\delta $  Front steering angle 
$p$  Steering rate 
${T}_{sw}$  Steering torque 
$\theta $  The heading angle of the vehicle 
Taking the effect of the longitudinal load transfer on the front and rear axles into account, the vertical forces of the front and rear wheels are:
where ${h}_{g}$ is the height of the center of gravity.
The vehicle velocity in the body coordinate is projected in the Earth coordinate defined by $x$ and $y$ as:
According to Eq. (1) and Eq. (4), the state equation can be described as:
where $x\left(t\right)$ and $z\left(t\right)$ are the states and the input which are denoted respectively as $x\left(t\right)={\left[u\left(t\right),v\left(t\right),\omega \left(t\right),\delta \left(t\right),p\left(t\right),x\left(t\right),y\left(t\right),\theta \left(t\right)\right]}^{T}$, $z\left(t\right)=\left[{T}_{sw}\right(t){]}^{T}$.
2.2. Constrains
The constraints of initial and terminal states are:
In order to avoid pitch and yaw of the vehicle, the path constraint is [17]:
where $D$ is the wheel base, $K$ is the stability factor.
The constraints on ${F}_{xf}$, ${F}_{xr}$ are imposed when the vehicle is driven by the front wheels [18]:
When all the wheels are assumed as lockbraking, the constraints on ${F}_{xf}$, ${F}_{xr}$ can be rewritten in the following manner:
The boundary constraint is:
where ${z}_{min}$ and ${z}_{max}$ are the lower and upper limit values of the steering torque.
2.3. Optimal control object of path tracking problem
The minimum time problem of path tracking can be regarded as the optimal control problem in the control theory. The control target is to control the control variables to ensure the vehicle passing the given path within the minimum time. Therefore, the minimum time performance indicator is [19]:
where ${t}_{0}$ and ${t}_{f}$ are the initial and final time.
3. Adaptive Gaussian pseudospectral method
3.1. Continuous Bolza type problem
The minimum time optimal control problem can be treated as a Bolza problem [16].
The Bolza cost function is:
where ${t}_{0}$ and ${t}_{f}$ are the initial and final time, $\mathbf{x}\left(t\right)\in {\mathbf{R}}^{n}$, $\mathbf{z}\left(t\right)\in {\mathbf{R}}^{m}$.
The dynamic and boundary constraints as well as inequality path constraint are:
In Eqs. (13)(16), the function $\psi $, $g$, $f$, $\phi $ and $C$ are defined as follows:
The indirect method transforms the above Bolz problem into a Hamiltonian boundary problem by introducing the Hamiltonian function based on the Ponte Liya maximum principle. The Hamiltonian function is defined as:
The optimal trajectories of the whole state variables and control variables can be obtained by solving a twopoint boundary value problem composed of Hamiltonian equations, boundary conditions and path constraints.
3.2. AGPM
Gaussian pseudospectral method (GPM) separates the state variables and control variables on a series of collocations, and then uses the Lagrangian interpolation basis function to approximate the state variables and control variables with the discrete points as nodes. The derivative of the state variable to time can be approximated by deriving the global interpolation polynomial. The integral term in the performance index can be approximated by the Gaussian integral formula with high accuracy. The terminal state is obtained by integral of the initial state and the right function. After the above numerical approximation, the continuous optimal control problem can be transformed into a discrete nonlinear programming problem under a series of algebraic constraints.
GPM takes the Korder LegendreGauss point and the beginning and ending points as nodes to constitute $K+1$ Lagrangian interpolation polynomials. So the state and control variables can be approximated as [20]:
where ${L}_{i}\left(\tau \right)$ is Lagrange interpolating polynomials, $\mathbf{x}\left({\tau}_{i}\right)=\mathbf{X}\left({\tau}_{i}\right)$, $\mathbf{z}\left({\tau}_{i}\right)=\mathbf{Z}\left({\tau}_{i}\right)$.
For the state variable approximation Eq. (18), the kinetic differential constraint equation can be transformed into the following algebraic constraint:
where $\mathbf{D}\in {\mathbf{R}}^{n\times (n+1)}$.
The interpolation nodes in GPM include $N$ LG points, ${\tau}_{1},{\tau}_{2}\cdots ,{\tau}_{N}$, the initial point ${\tau}_{0}\equiv 1$, and the final point ${\tau}_{f}\equiv 1$. Since ${X}_{f}$ is absent in the state approximation, it must be constrained in other ways to ensure that it satisfies the state dynamic equation. This is accomplished by including an additional constraint that relates the final state to the initial state via a Gauss quadrature. According to the state dynamics:
The integral function which is developed by GaussLobatto integral approximation formula with the highest accuracy can be described as:
where ${\tau}_{i}$ is the LG point, ${\omega}_{k}$ are the Gauss weights.
Then, the integral term in Eq. (13) can be approximated with a Gauss quadrature as before:
The boundary condition and the path constraint condition can be obtained at the interpolation points:
Finally, the vehicle path tracking with the minimum time problem is defined as a NLP by the cost function of Eq. (23), the algebraic constraints of Eq. (20), Eq. (24), and Eq. (25).
GPM is a pseudospectral method based on the global interpolation polynomial. In order to improve the approximation accuracy, the abovementioned global approximation pseudospectral method must increase the time node which will greatly increase the number of design variables and then will increase the calculation time. In the region where the approximation accuracy is smaller than the specified accuracy, the proposed pseudospectral method can improve the approximation accuracy by adding a fragment or a node in the region. However, the AGPM does not exist in the area where the accuracy satisfies the requirement, which contributes to improving computational efficiency.
Compared with the GPM mentioned in the previous section, the AGPM divides the whole problem into several fragments, and the GPM is applied in each segment. It is assumed that the problem contains $S$ fragments and $N$ collocation points:
In this case, the kinetic approximation in Eq. (20) can be expressed as:
It is obvious that the differential matrix of the segmentation collocation method (Eq. (27)) contains relatively few nonzero elements and is sparser than the differential matrix in the global configuration method of Eq. (20) contributing to improve the computation efficiency of the nonlinear programming algorithm and to reduce the calculation time. However, the reduction of the configuration point may reduce the corresponding approximation accuracy within each segment. On the other hand, the increase of the configuration point within each segment will make the whole nonlinear programming problem become more complicated and increase the computation time. In order to minimize the calculation time under the premise of ensuring the approximation accuracy, the AGPM automatically increases the configuration point or the fragment in the region where the accuracy does not meet the requirements. However, the AGPM does not change in the area where the accuracy satisfies the requirement to ensure the approximation accuracy while reducing the calculated pressure. In the region where the approximation accuracy does not meet the requirements, the AGPM determines whether the segment or the configuration point should be added by judging the form of the midpoint residual matrix. Firstly, the midpoint time ${\stackrel{}{t}}_{i}$ of each segment can be expressed as:
It is set that $\stackrel{}{\mathbf{X}}\in {\mathbf{R}}^{({N}_{s}1)\times n}$ and $\stackrel{}{\mathbf{Z}}\in {\mathbf{R}}^{({N}_{s}1)\times m}$ are state and control variable matrixes respectively at the time of ${\stackrel{}{t}}_{i}$. The midpoint residual matrix $\mathbf{R}$ is defined as:
where $\stackrel{}{\mathbf{D}}\in {\mathbf{R}}^{({N}_{s}1)\times ({N}_{s}1)}$ is the differential matrix at $\stackrel{}{\mathbf{\tau}}=({\stackrel{}{\tau}}_{1},\cdots ,{\stackrel{}{\tau}}_{{N}_{s}1})$.
The midpoint residual $\beta $ is defined as:
where column vector $\mathbf{r}\in {\mathbf{R}}^{({N}_{s}1)\times 1}$ is a column matrix containing the largest residual term in the midpoint residual matrix $\mathbf{R}$; $\stackrel{}{r}$ is the mean arithmetic value of $\mathbf{r}$, that is $\stackrel{}{r}=\frac{\sum _{i=1}^{{N}_{s}1}r\left({t}_{i}\right)}{{N}_{s}1}$. When each element of the midpoint residual vector $\mathbf{\beta}$ is equivalent, it is called the uniform residual vector; otherwise, it is called the nonuniform residual vector.
Let $\epsilon $ be the specified allowable deviation, and take into account the case where the maximum residual in Eq. (30) is greater than $\epsilon $. When the element’s positions in the consistent residual vector $\mathbf{\beta}$ exceed the specified threshold $\rho $ ($\rho >$1), the placement point increase method within the segment is used to improve the approximation accuracy. That is ${N}_{s}^{\mathrm{\text{'}}}={N}_{s}+S$, where $S$ is the number of added nodes.
When the element’s positions in the nonuniform residual vector $\mathbf{\beta}$ exceed the maximum allowable error $\rho $, the segment addition method at the time corresponding to the maximum element of the residual vector $\mathbf{\beta}$ is proposed to improve the approximation accuracy. If there are multiple largest elements, it is necessary to add the fragment at the corresponding moment of each largest element to improve the approximation accuracy.
The AGPM automatically adds a configuration point or fragment by automatically determining the value and form of the residual vector $\mathbf{\beta}$ until the accuracy satisfies the requirement in areas where the accuracy does not meet the requirements. In particular, the AGPM can ensure better performance in improving the approximation accuracy and the operation speed of the path tracking optimization problem.
The control strategy of the AGPM is:
Step 1: Initializing parameters and setting initial number of the collocations.
Step 2: The optimal control problem at the set collocations is discretized and transformed to a NLP problem.
Step 3: Solving the NLP problem.
Step 4: Determining if the dynamic constraint, the path constraint, the state and the control constraint at the midpoint of each element satisfy the given allowable deviation $\epsilon $. If it is satisfied, the iteration stops. If not, step 5 is proceed.
Step 5: Determining if each element in the normalized midpoint residual vector $\mathbf{\beta}$ is smaller than the midpoint residual index $\rho $. If it is satisfied, step 6 is proceed. If not Step 7 is proceed.
Step 6: Increasing the number of collocations in the unit. That is to say, increasing the order of the Legendre interpolation polynomial, and then going to Step 3.
Step 7: Refining the corresponding unit to multiple units and going to Step 3.
The control block diagram is shown in Fig. 2.
Fig. 2. The control block diagram of the AGPM
4. Numerical simulation and experimental verification
4.1. Simulation result
Simulation is carried out in Matlab software to verify the method.
The parameters of the real vehicle used in the simulation are shown in Table 2.
Table 2. Simulation parameters
Symbol  Value  Unit 
$m$  1500  kg 
${I}_{z}$  2080  kg﹒m^{2} 
$a$  1.185  m 
$b$  1.283  m 
$i$  20  
${C}_{\phi 1}$  63237  N·m/rad 
${C}_{\phi 2}$  31458  N·m/rad 
${c}_{f}$  –60533  N/rad 
${c}_{r}$  –110185  N/rad 
${h}_{g}$  0.53  m 
The tracked path is prescribed as the pylon course slalom test road shown in Fig. 3. A vehicle travels along the pylon course slalom test road. The vehicle should pass through the prescribed road within the minimum time.
In realistic driving process, the ideal target drivers’ trajectory should be described as a curve of order three with continuous firstorder derivative:
From Eq. (31) it is easy to obtain the relationship between $y$, i.e.$f\left(x\right)$ and $x$ by substituting $t$ with $x/u$.
Fig. 3. Pylon course slalom test road (● stands for stake), where ${s}_{0}=L=2u$, $s=3u$, $u$ is the longitudinal speed. $B$ is the rotary distance, $B=$ 2.46 m. $L$ is the distance between the stakes
Fig. 4. Fitted pylon course slalom test road
The optimization is calculated by SQP algorithm and MATLAB software in a computer which CPU is 2.8 GHz/Pentium IV, and operating system is Window XP. The minimum time for the vehicle accomplishing the pylon course slalom test road process is 14.9 seconds after 15 iterations.
Fig. 5 describes the result of the lateral distance of traveling along the pylon course slalom test road. It can be seen from the figure that the vehicle can successfully complete the pylon course slalom test road process without crossing the road boundary conditions with the speed of 90 km/h indicating good control performance of the proposed method.
Fig. 6 is the simulation result of steering torque. It can be seen from the figure that there are peak values at 140 m, 175 m, 240 m, and 280 m, indicating that the driver manipulates the car strenuously.
Fig. 5. Lateral distance
Fig. 7 is the simulation result of the traction force of front wheel. The figure indicates that the traction force of front wheel keeps growing until 1.63 kN. However, it can be seen from the curve that the curve slope keeps being small until 0 at 400 m.
Fig. 8 is the simulation result of the longitudinal velocity. It is shown that longitudinal velocity keeps growing until 127 km/h. So, the driver should be cautious about maneuvering the car.
Fig. 6. Steering torque
Fig. 7. Traction force of front wheel
Fig. 8. Longitudinal velocity
4.2. Evaluation of obstacle avoidance capability
In order to compare the obstacle avoidance capability of different vehicles in the same path trajectory conditions, another vehicle which is remarked as vehicle 2 (The vehicle referred above is remarked as vehicle 1) completes the pylon course slalom test road process without crossing the road boundary conditions with the speed of 90 km/h. And the parameters of vehicle 2 used in the simulation are shown in Table 3.
Table 3. Simulation parameters
Symbol  Value  Unit 
$m$  1265  kg 
${I}_{z}$  1800  kg·m^{2} 
$a$  1.170  m 
$b$  1.195  m 
$i$  20  
${C}_{\phi 1}$  60544  N·m/rad 
${C}_{\phi 2}$  32750  N·m/rad 
${c}_{f}$  –60042  N/rad 
${c}_{r}$  –109295  N/rad 
${h}_{g}$  0.53  m 
Fig. 9(a) is the simulation result of lateral displacement of the two vehicles. It can be seen that the lateral displacement of the two vehicles is almost coincident. The pattern of motion for the vehicles is that the vehicles travel along a straight line almost between the road borders. Fig. 9(b) is the simulation result of the steering torque of the two vehicles. It can also be seen from the figure that the amplitude of steering torque of vehicle 1 is larger than that of vehicle 2. The obstacle avoidance capability can be evaluated objectively by calculating the minimum time of the vehicles completing the pylon course slalom test road process. The evaluation of obstacle avoidance capability is shown in Table 4.
Table 4. Evaluation of obstacle avoidance capability
Comment contents  Vehicle  
Vehicle 1  Vehicle 2  
Minimum time (s)  90 km/h  14.9  15.6 
Obstacle avoidance capability  Better  Poor 
Fig. 9. Evaluation of obstacle avoidance capability
a) Lateral distance
b) Steering torque
c) Steering rate
4.3. Analysis of control efficiency
In order to analyze the control efficiency of the AGPM compared with the traditional method (Direct parallel method [21] and LQR [22]), simulation with same conditions is established. The tracked trajectory is the double lane change test road.
The double lane change test road is described in Fig. 10.
Fig. 10. Double lane change test road (● stands for stake), where ${s}_{0}={s}_{1}={s}_{2}={s}_{4}=2u$, ${s}_{3}=u$, ${s}_{5}=5u$, ${s}_{6}=3u$. $B$ is the distance of lanechange, $B=$3.5 m. ${B}_{1}$, ${B}_{2}$ and ${B}_{3}$ are the distances between the stakes, ${B}_{1}=1.1H+0.25=$ 2.12 m, ${B}_{2}=1.2H+0.25=$2.29 m, ${B}_{3}=1.3H+0.25=$2.46 m, where $H$ is the width of the vehicle, $H=$ 1.7 m
In a realistic driving process, drivers’ ideal target trajectory should be a lowlevel continuous smooth curve shown in Fig. 3. And also, according to ISO/TR38882004, the trajectory of the vehicle traveling along the pylon course slalom test road should be described as a curve of order three with continuous firstorder derivative transformed with cubic splines fitting:
where:
$d={a}_{1}{a}_{0},{d}^{\mathrm{\text{'}}}={a}_{2}{a}_{3},$
${e}_{0}={a}_{0}^{2}\left(3{a}_{1}{a}_{0}\right)\frac{B}{{d}^{3}},{e}_{1}=6{a}_{0}{a}_{1}\frac{B}{{d}^{3}},{e}_{2}=3\left({a}_{0}+{a}_{1}\right)\frac{B}{{d}^{3}},{e}_{3}=2\frac{B}{{d}^{3}},$
${e}_{0}^{\mathrm{\text{'}}}={a}_{3}^{2}\left(3{a}_{2}{a}_{3}\right)\frac{B}{d{\mathrm{\text{'}}}^{3}},{e}_{1}^{\mathrm{\text{'}}}=6{a}_{3}{a}_{2}\frac{B}{d{\mathrm{\text{'}}}^{3}},{e}_{2}^{\mathrm{\text{'}}}=3\left({a}_{3}+{a}_{2}\right)\frac{B}{d{\mathrm{\text{'}}}^{3}},{e}_{3}^{\mathrm{\text{'}}}=2\frac{B}{d{\mathrm{\text{'}}}^{3}}.$
Fig. 11. Fitted double lane change test road
From Eq. (32) it is easy to obtain the relationship between $y$, i.e.$f\left(x\right)$ and $x$ by substituting $t$ with $x/u$:
where ${g}_{0}={e}_{0}$; ${g}_{i}={e}_{i}{u}^{j}\mathrm{}(j=\mathrm{1,2},3)$; ${h}_{0}={e}_{0}^{\mathrm{\text{'}}}$; ${h}_{i}={e}_{i}^{\mathrm{\text{'}}}{u}^{j}\mathrm{}(j=\mathrm{1,2},3)$.
Simulation of lateral distance throughout the process of tracking the double lane change test road is shown in Fig. 12.
Fig. 12 indicates that the vehicle can track the double lane change test road well with speed of 105 km/h.
Fig. 12. Lateral distance of tracking the double lane change test road
The comparison results verifying the control efficiency of the proposed method is given in Fig. 13, which including the absolute error of the lateral distance between the simulation result and the double lane change test road as well as the Steering wheel angle.
Fig. 13. Evaluation of the control efficiency
a) Absolute error of lateral distance
b) Steering wheel angle
From the absolute error of lateral distance curve in Fig. 13(a), it can be concluded that the maximum value of the error of lateral distance based on AGPM is less than that of the direct parallel method indicating that the AGPM is superior in calculation accuracy to the direct parallel method for solving the optimum path tracking problem of vehicle handling dynamics.
From Fig. 13(b), it can be concluded that the maximum value of the front steering angle based on the AGPM is less than that of the LQR controller. A more clear description of the evaluation of calculation accuracy is shown in Table 5.
Table 5. Evaluation of calculation accuracy
Calculation results  Maximum value (absolute value)  
AGPM  LQR  
Steering wheel angle (°)  30  36 
So, it is proved that there is higher control effect for the AGPM to solve the path tracking problem comparing with other traditional methods.
4.4. Robustness verification in external disturbance environment
In this paper, a CClass Hatchback model in Carsim is used to implement the robustness verification of the proposed algorithm.
The longitudinal vehicle velocity, adhesion coefficient and maximum wind speed are set as 30 m/s, 0.8, and 50 km/h respectively. The step gust is shown in Fig. 14.
Fig. 14. Step gust
Fig. 15 shows that in the case of lateral wind, the vehicle still tracks the path well, indicating that the proposed algorithm can compensate robustness requirements in the external disturbance environment.
Fig. 15. Lateral distance in external disturbance environment
4.5. Experimental result
A real vehicle test was made to verify the correctness of the proposed algorithm. The block diagram of the test system and main measurement equipment is shown in Figs. 1618.
Fig. 16. Block diagram of test system
Fig. 17. Measurement equipment
a) GPSSD20 speed instrument
b) Steering torque/angle tester
c) Comprehensive performance test system of AM2800 vehicle
d) Lenovo computer
Fig. 18. Real test vehicle
The test procedure in accordance with ISO/TR38882004 is as follows:
Step 1: Arranging stakes shown in Fig. 3.
Step 2: Placing the related equipment shown in Fig. 17.
Step 3: A water injector is installed at the center of the front axle to spray water toward the ground in order to record the real traveling trajectory.
Step 4: Repeating Step 3 process 6 times.
The test values are shown in Figs. 19(a)19(c).
Fig. 19. Comparison of simulation and test value
a) Steering wheel angle
b) Traction force of front wheel
c) Longitudinal velocity
It can be seen from Fig. 19(a) that both the test value and the simulation value of the steering wheel angle have peak values at 140 m, 175 m, 240 m, and 280 m, that indicates that the driver manipulates the car strenuously. When the driver manipulates the vehicle passing the pylon course slalom test road, the driver has to increase the steering wheel angle to avoid the stakes so the test value is bigger than that of the simulation. Fig. 19(b) shows that the test value and the simulation value increase as the longitudinal distance increase, this is because the driver must tread the throttle pedal to accelerate the vehicle to track the described trajectory within the minimum time. And the figure shows that the test value is smaller than the simulation value. This is because the driver must control the gears and throttle pedal to prevent the occurrence of side slip or rolling. At the same time, there are some errors in test equipment resulting in differences between test and simulation results. As shown in Fig. 19(c), both the test value and the simulation value of the longitudinal velocity increase as the longitudinal distance increases. This is because the driver must accelerate the vehicle to track the described path within the minimum time. But the test value is smaller than the simulation value. This is reasoned by that there are psychological problems in performing a certain impact on the test results for the driver driving the vehicle at a high speed. From Fig. 19(c), it is also can be seen that the error between the simulation and the real test values increases as the longitudinal distance increases. Both the simulation and the real test values tend to two lines almost with different slopes caused by driving skill and psychological burden under the condition of vehicle tracking the described path within the minimum time. At the same time, the two lines have the same starting coordinates (0, 25), that is why the error between the simulation and the real test values occurs for the longitudinal distance.
However, the simulation and the experimental values are consistent, verifying the correctness of the proposed algorithm.
The authors declare that there is no conflict of interests regarding the publication of this paper.
5. Conclusions
In this paper, the AGPM method is utilized to analyze the problem of vehicle tracking the desired path within the minimum time. Based on a 4DOF simplified vehicle model, the AGPM method is proposed to solve the problem of path tracking with a maneuver as quickly as possible.
To verify the performance of the proposed method, a simulation is conducted, and its results show that the minimum time for the vehicle (vehicle 1) accomplishing the pylon course slalom test road process is 14.9 seconds after 15 iterations. And also, the proposed method can be used to research for an optimized trajectory directly. This is the main benefit of this method for path tracking control problem within the minimum time.
The results of comparison between the AGPM and other traditional methods (Direct parallel method and LQR) method show that there is higher control effect for the AGPM to solve the path tracking problem comparing with other traditional methods under the same computation conditions.
In future research, the aim would to be conduct comprehensive evaluation of driver’s burden in the path tracking with minimum time problem and identify driver model parameters in the closedloop method as well as verifying driver physiological limit. In the future, the proposed algorithm can be used to improve vehicle handling performance and provides valuable insight into the lane changes design work and can develop target tracking as well as collision avoidance techniques in the area of vehicle safety.
6. Data availability
The experimental data used to support the findings of this study are currently under embargo while the research findings are commercialized. Requests for data, [6/12 months] after publication of this article, will be considered by the corresponding author.
Acknowledgements
This paper was supported by the Science and Technology Program Foundation of Weifang under Grant 2015GX007. The first author gratefully acknowledges the support agency.
References
 Amer N. H., Hudha K., Zamzuri H. Adaptive modified Stanley controller with fuzzy supervisory system for trajectory tracking of an autonomous armoured vehicle. Robotics and Autonomous Systems, Vol. 105, Issue 1, 2018, p. 94111. [Publisher]
 Mengyin F., Kai Z., et al. Collisionfree and kinematically feasible path planning along a reference path for autonomous vehicle. IEEE Intelligent Vehicles Symposium (IV), Korea, 2015. [Search CrossRef]
 Zambom A. Z., Collazos J. A. A., Dias R. Constrained optimization with stochastic feasibility regions applied to vehicle path planning. Journal of Global Optimization, Vol. 64, Issue 4, 2016, p. 803823. [Publisher]
 Vilela D., Barbosa R. S. Numerical optimization methods applied to the concurrent problem of vehicle ride and handling. International Journal of Vehicle Systems Modelling and Testing, Vol. 8, Issue 4, 2013, p. 316334. [Publisher]
 Zhang He, Yang S. W. Smooth path and velocity planning under 3D path constraints for carlike vehicles. Robotics and Autonomous Systems, Vol. 107, Issue 5, 2018, p. 8799. [Publisher]
 Yang I. B., Na S. G., Heo H. Intelligent algorithm based on support vector data description for automotive collision avoidance system. International Journal of Automotive Technology, Vol. 18, Issue 1, 2017, p. 6977. [Publisher]
 Fu M. M., Ni J., Li X. Y., Hu J. B. Path tracking for autonomous race car based on GG diagram. International Journal of Automotive Technology, Vol. 19, Issue 4, 2018, p. 659668. [Publisher]
 Krid M., Benamar F., Lenain R. New explicit dynamic path tracking controller using generalized predictive control. International Journal of Control, Automation and Systems, Vol. 15, Issue 1, 2017, p. 303314. [Publisher]
 Amer N. H., Zamzuri Hairi, Hudha Khisbullah, et al. Path tracking controller of an autonomous armoured vehicle using modified Stanley controller optimized with particle swarm optimization. Journal of the Brazilian Society of Mechanical Sciences and Engineering, Vol. 40, Issue 104, 2018, p. 103119. [Search CrossRef]
 Guo J. H., Luo Y. G., Li K. Q., Dai Y. F. Coordinated pathfollowing and direct yawmoment control of autonomous electric vehicles with sideslip angle estimation. Mechanical Systems and Signal Processing, Vol. 105, Issue 1, 2018, p. 183199. [Publisher]
 Memon K. R., Memon S., Memon B., et al. Real time implementation of path planning algorithm with obstacle avoidance for autonomous vehicle. 3rd International Conference on Computing for Sustainable Global Development, 2016, p. 20482053. [Search CrossRef]
 Setiawan Y. D., Nguyen T. H., Pratama P. S., et al. Path tracking controller design of four wheel independent steering automatic guided vehicle. International Journal of Control, Automation and Systems, Vol. 14, Issue 6, 2016, p. 15501560. [Publisher]
 Zou Ting, Angeles J., Hassani Ferri Dynamic modeling and trajectory tracking control of unmanned tracked vehicles. Robotics and Autonomous Systems, Vol. 110, Issue 4, 2018, p. 102111. [Publisher]
 Yu M., Xin G., Yu W., Qing G. LQRGA controller for articulated dump truck path tracking system. Journal of Shanghai Jiaotong University (Science), Vol. 24, Issue 1, 2019, p. 7885. [Publisher]
 Wang J. X., Wang J. M., Wang R. R., et al. Framework of vehicle trajectory replanning in lane exchanging with considerations of driver characteristics. IEEE Transactions on Vehicular Technology, Vol. 66, Issue 5, 2017, p. 35833596. [Search CrossRef]
 Liu Y. J., Jiang J. S. Optimum path tracking control for inverse problem of vehicle handling dynamics. Journal of Mechanical Science and Technology, Vol. 30, Issue 8, 2016, p. 34333440. [Publisher]
 Zhang L. X., Zhao Y. Q., Song G. X. Research on inverse dynamics of vehicle minimum time maneuver problem. China Mechanical Engineering, Vol. 18, Issue 21, 2007, p. 26282632, (in Chinese). [Search CrossRef]
 Jin Z. L., Weng J. S., Hu H. Y. Rollover stability of a vehicle during critical driving maneuvers. The Proceedings of the Institution of Mechanical Engineers, Part D: Journal of Automobile Engineering, Vol. 221, Issue 9, 2007, p. 10411049. [Search CrossRef]
 Casanova D. On Minimum Time Manoeuvring: The Theoretical Optimal Lap. Cranfield, England, 2000. [Search CrossRef]
 Sun Z. Y., Jin G., Zhang L., Yang X. B. SGCMG nonsingularity trajectory programming algorithm based on adaptive gauss pseudospectral method. Journal of Astronautics, Vol. 33, Issue 5, 2012, p. 597604. [Search CrossRef]
 Vavrina M. A., Englander J. A., Ellison D. H. Global optimization of Nmaneuver, highthrust trajectories using direct multiple shooting. 26th AAS/AIAA Spaceflight Mechanics Meeting, United States, 2016. [Search CrossRef]
 Chen, H. Study on path following control method for automatic parking system based on LQR. SAE International Journal of Passenger Cars – Electronic and Electrical Systems, Vol. 10, Issue 1, 2017, p. 4149. [Search CrossRef]
Cited By
Aerospace Science and Technology
Guanlin Li, Tao Chao, Songyan Wang, Ming Yang

2022
