1. Introduction
The advancement and development of automated driving technology, along with the modernization of economic levels, have led to the development of new automobile technology that is becoming more intelligent and electrified. Additionally, unmanned electric vehicles that can operate in challenging environments are being used extensively. With its fully wire-control integrated chassis and independent-driving and -braking capabilities, the unmanned electric vehicle can significantly increase operational accuracy and efficiency, in addition to taking the place of manual labor in challenging conditions [
1]. Thus, the key to the development of China’s modern industry is the research and development of unmanned vehicles with autonomous precision operation functions that are suitable for complex working conditions. Trajectory-tracking control is the foundation that enables unmanned vehicles to realize autonomous, precise operation.
Many academics are currently conducting extensive research on trajectory-tracking control techniques. PID control [
2], optimal control [
3], sliding mode control [
4], fuzzy control [
5], and other techniques are frequently utilized in trajectory-tracking control. These methods can reduce computational time and simplify the control model. Because of the nonlinearity of the vehicle system, the weight parameters must be modified to account for the system’s ability to adapt to changing operating conditions. Consequently, there is a great deal of reliance on the weight parameters. The most versatile among them is model predictive control (MPC), which possesses the qualities of a predictive model, rolling optimization, and feedback correction. It can handle multi-objective and multi-variable optimization problems with constraints [
6], has drawn the interest of numerous academics, and has the widest range of applications. For instance, Xu [
7] created a fuzzy MPC controller that enhanced trajectory-tracking accuracy by adaptively modifying the weight coefficients in response to field roads’ curvature. By introducing a gradient-projection technique, Liu [
8] et al. decreased the number of iterative steps in the MPC algorithm and increased the trajectory-tracking controllers’ response time. Yan [
9] optimized the controller’s overall efficiency by adaptively adjusting the adaptive MPC controller’s predictive time domain based on the curvature of roadways. Li et al.‘s adjustments to the weight matrix of the goal function in the MPC increase the controller’s accuracy and stability [
10,
11,
12]. For the vehicle lane-changing problem with constraints on multiple state quantities, Ji [
13] proposed a multi-constrained model predictive trajectory-tracking control method by creating a reference predetermined trajectory based on the trapezoidal acceleration method. However, on low-adhesion roads, the yaw rate does not accurately reflect the lateral stability of the vehicle.
Despite the trajectory-tracking control problem of unmanned vehicles under changes in the road lateral inclination and the coefficient of road adhesion, the above studies have not considered the influence of such road surface factors on the MPC trajectory-tracking controller, and in this regard, in recent years, variable-parameter MPCs have been developed to improve the model accuracy and adaptability to working conditions. Amir et al. [
14] used model switching to meet the computational efficiency requirements under complex working conditions and improve tracking performance under simple working conditions, but their method also faced the problem of a loss of precision and accuracy. Some scholars have improved the adaptivity by changing the time domain [
15,
16] and sampling frequency [
17], but this method causes rough changes in control quantity, and the accuracy and reliability of the control inputs are thus difficult to guarantee. Liu [
18] established an intelligent vehicle dynamics model considering the roadway inclination and constrained the safety of the vehicle’s sideways inclination, which can effectively prevent the vehicle from rollover in mountainous environments, but the method did not consider the effect of the nonlinear side bias characteristics of tires on the control accuracy. Cui [
19] proposed a path-tracking controller with corner envelope constraints, which had better trajectory-tracking accuracy at different coefficients of road adhesion. However, it only took the lateral displacement as the evaluation index, which was prone to the risk of vehicle instability caused by the lateral stability of the vehicle exceeding the envelope under the premise of setting the relaxation factor to ensure a feasible solution. As the above methods all set the weight of each evaluation index as a fixed value, it became difficult to adaptively adjust the vehicle when the driving conditions changed, and thus it was difficult to ensure that the vehicle had good dynamic control performance [
20]. When an unmanned vehicle is traveling in a complex mountain environment, the tire cornering stiffness is very easy to change in accordance with the driving status of the body and the road surface adhesion. Li [
21] considered the effect of load transfer on tire cornering stiffness and obtained real-time tire cornering stiffness by fitting recursive least square to the current tire slip angle and load transfer, but the method failed to consider the effect of the coefficient of road adhesion on the tire sidewall bias characteristics.
In view of this, in order to enhance the adaptive ability of unmanned vehicles in trajectory tracking under complex working conditions, such as the uncertainty of the road surface attachment coefficient, the large curvature of the reference path, and sideways road inclinations, it is possible to enhance the accuracy of trajectory tracking while ensuring the driving stability of the vehicle. We first establish a trajectory-tracking model of unmanned vehicles considering road lateral inclination angle in view of the road characteristics of complex working conditions. Secondly, the lateral forces of the front and rear tires are estimated based on the square root cubature Kalman filter (SRCKF), and the tire cornering stiffness is corrected in real time according to the lateral force of the tires so as to improve the adaptive ability of the model under complex working conditions. And an adaptive prediction time-domain method based on the Gaussian function is designed, which can adaptively optimize the size of the predicted time domain according to the road surface adhesion coefficient and path curvature. Finally, the proposed Adaptive Model Predictive Control (AMPC) trajectory-tracking control method is validated by the joint simulation of Carsim and MATLAB/Simulink.
3. Estimation of Tire Cornering Stiffness
3.1. Nonlinear Characterization of Tires
The correctness of the expression of the nonlinear properties of the tires has a direct impact on the control accuracy of the vehicle model since the road forces on the autonomous vehicle must be passed through the tires [
22,
23,
24,
25]. As a result, we decided to use Professor Pacejka’s magic formula to explain the nonlinear structural characteristics of tires. This is how the magic tire formula gets put into expression:
where
is the wheel lateral deflection angle;
is the wheel lateral force;
are the stiffness, shape, peak, and curvature factors, respectively; and
is the drift of the curve in the vertical and horizontal directions, respectively.
The Magic Tire formula is used to describe the relationship between the corresponding tire side deflection angle and lateral force under different working conditions, as shown in
Figure 3 and
Figure 4 below. In
Figure 3, it can be seen that if the vertical load has a fixed value of 5 kN, since the size of the road surface attachment coefficient determines the slip limit of the tire [
26], the larger the road surface attachment coefficient, the larger the extreme value of the lateral force. As can be seen in
Figure 4, when the road surface attachment coefficient is 0.9, the change of vertical load will affect the size of the tire cornering stiffness, and the vertical load will change with the change of the vehicle driving status and body mass, and at the same time, the tire cornering stiffness also changes. If the constant tire cornering stiffness continues to be used for the calculation of the tire force, a large model error will be generated.
When designing the controller, it is difficult to adapt the tire force calculated using linear stiffness to changes in road adhesion and load transfer. Therefore, it is necessary to adaptively adjust the lateral stiffness of the controller based on the real-time tire lateral force.
3.2. Lateral Force Estimation
In order to obtain real-time front and rear tire lateral forces, we designed a lateral force estimator based on SCKF. SCKF is the square root form of CKF, which can guarantee symmetry and a positive semi-qualitative covariance matrix. Compared with the EKF and UKF algorithms, the SCKF algorithm has higher estimation accuracy and filtering stability.
It is assumed that the variation of lateral forces in each tire during vehicle travel is consistent with a Markov process, and the variation is described using a second-order stochastic wandering model.
where
is the tire force to be estimated;
is the first-order derivative of
;
is random noise. If the state variable is defined to be
and the measurement variable is defined to be
, combining Equations (1) and (9), the state-space equation in discrete form can be expressed as follows:
where
is the state transfer equation;
is the measurement equation;
is the process noise with covariance
;
is the measurement noise with covariance
. Using the first-order Euler equation with a sampling time of
to approximate the discretization of the system, the state transfer equation and the measurement equation can be expressed as, respectively:
The lateral force estimation based on the SCKF algorithm is implemented as follows.
Step 1: Set the initial value of the state and its error covariance matrix square root factor .
Step 2: Time update.
Calculate the volume points and transfer them using the state transfer equation.
where
is the column
of the volume point weight matrix
;
is the unit matrix of
;
is the dimension of the state variable.
Calculate the predicted value of the state and the square root factor of its error covariance matrix:
where
denotes
the decomposition; the weighted center matrix
is
Step 3: Measurement update.
Update the volumetric points and transfer them using the measurement equation.
Calculate the predicted values of the measured variables and the square root factors of their new interest covariance matrices:
where the weighted center matrix
is
Calculate measurement covariance matrix and mutual covariance matrix:
where the weighted center matrix
is
Calculate the filter gain matrix:
Update the state variables and the square root factor of the error covariance matrix:
3.3. Simulation Verification of Lateral Force Estimation
The designed SCKF estimator was tested by using Carsim and the Matlab/Simulink joint simulation platform, and the two working conditions of a high-adhesion road surface and low-adhesion road surface were set for validation, respectively, in which the high-adhesion condition was set with a road adhesion coefficient of 0.9 and a vehicle speed of 90 km/h, and the low-adhesion condition was set with a road adhesion coefficient of 0.4 and a vehicle speed of 50 km/h. The initial state , the square root of the error covariance was taken as , the process noise covariance was taken as , and the measurement noise covariance was taken as .
Under this condition, the measured values after considering the measurement noise were used as the measurement inputs to the estimator, and the estimation results of the front and rear tire forces were obtained, as shown in
Figure 5 and
Figure 6.
In
Figure 5 and
Figure 6, the SCKF estimator can obtain the front and rear tire lateral forces of the vehicle in real time, and the estimated values can match well with the real values obtained based on Carsim. Therefore, the designed estimator can be used to identify the trend of the front and rear tire lateral forces and provide effective data support for the design of the controller.
3.4. Tire Cornering Stiffness Correction
Repeat the above steps to obtain the estimated values of tire lateral force
and
. Due to the influence of estimation residuals, the ratio of tire lateral force and lateral deflection angle is directly used to solve the tire cornering stiffness [
27,
28,
29], which is prone to produce singular values. This study adopts the normalization parameter to correct the tire cornering stiffness.
In order to avoid singular values of the correction factor with a denominator of 0 and to prevent the correction factor from varying too much [
30], the following constraints are placed on
:
In the formula, when the tire side deflection angle is less than 1°, the correction coefficient is set to 0, and the corrected tire cornering stiffness can be expressed as
Thus the modified system equation of state can be obtained as
where
and
are the corrected system state matrix and system control matrix. So far, the tire stiffness is corrected in real time according to the low-cost sensor information, and the vehicle model based on SRCKF tire cornering stiffness correction is obtained, which can reduce the influence of parameter uncertainty on the system and then be embedded in the MPC to improve the accuracy and stability of trajectory tracking, which is used in this study for the design of the subsequent controller.
5. Adaptive Trajectory-Tracking Controller Design
In this study, CarSim (2020.0) and MATLAB (2022b)/Simulink co-simulation were used as the system test platform to construct the classical MPC controller (MPC), tire cornering stiffness adaptive MPC controller (KF-MPC), and tire cornering stiffness and time domain adaptive MPC controller (KF-AG-MPC), respectively. The basic parameters of the three controllers are set the same: the prediction time domain
, the control time domain
, the upper limit of the pre-scanning distance
m, the lower limit
m, and the sampling time
. In order to verify the adaptability of the trajectory-tracking controller in an all-terrain environment, a double-lane road with a variable lateral inclination angle and variable coefficient of road adhesion was set up to test the controller. The longitudinal speed of the unmanned vehicle was 72 km/h; it is assumed that the road surface attachment coefficient is 0.6 in the 0–70 m interval of the road and 0.4 in the 70–200 m interval. The controller framework diagram is shown in
Figure 9 below:
In order to verify the reasonableness of the Simulink model of the unmanned vehicle built in this paper, according to the steering transient response experiment (steering disc angle step input), the response characteristics are compared with those of the Carsim model under the working condition of a 50 km/h steering disc angle step, as shown in
Figure 10.
As can be seen in
Figure 10, the Simulink model of the unmanned vehicle constructed in this study agrees with the trend of the yaw rate and the Beta output from the Carsim vehicle model, which proves that the present model is reasonable.
The comparison of the control effects of the three controllers under double-shift conditions is given in
Figure 11 and
Figure 12 and
Table 1. In
Figure 11 and
Figure 12, it can be seen that the KF-MPC and KF-AG-MPC have a greater improvement in trajectory-tracking accuracy and vehicle lateral stability compared with the classical MPC controller. This is because the KF-MPC controller can correct tire cornering stiffness in real time according to the driving state of the vehicle, which fully considers the nonlinear characteristics of the tire and greatly reduces the control error caused by the model deviation, while the KF-AG-MPC further improves the trajectory-tracking accuracy and vehicle stability of the vehicle in the curve through the adaptive time domain by taking into consideration the influence of the road surface coefficient of adhesion and the curvature of the road surface on the basis of the KF-MPC. The trajectory-tracking accuracy and vehicle stability are further improved by the adaptive time domain, so that the vehicle is able to improve the tracking accuracy while ensuring the lateral stability of the vehicle under complex working conditions.
The error statistics of the three controllers designed in this study are shown in
Table 1, in which the KF-AG-MPC controller has the best control effect. Compared with the classical MPC controller, the peak lateral error is reduced by 64.46%, the average lateral tracking error is reduced by 73.07%, the peak yaw rate is reduced by 47.51%, and the peak Beta is reduced by 50.89%. The control accuracy and stability of the whole vehicle are significantly improved.
Figure 13 and
Figure 14 show the adaptive curve of tire cornering stiffness and time domain. In
Figure 13, the tire cornering stiffness as a dynamic parameter is corrected in real time along with the driving state of the vehicle, which reflects the time-varying characteristics of the tire cornering stiffness. In
Figure 14, the predicted time domain is adaptively adjusted according to the changes in road surface adhesion coefficient and road curvature, which improves the tracking control accuracy.
6. Conclusions
In order to improve the adaptive ability of trajectory-tracking control of unmanned vehicles under complex working conditions, we estimated the tire lateral force online based on the SRCFK algorithm to correct the tire cornering stiffness and realize the real-time correction of the MPC state matrix and the control matrix. The accuracy of the vehicle model in the control algorithm was improved by transforming the complex and unpredictable empirical formula fitting problem into an estimation problem based on the energetic state quantities. The proposed Gaussian-based adaptive time-domain strategy was able to adjust the time-domain size according to the changes in road conditions, which can effectively coordinate the trajectory-tracking accuracy and lateral stability, smoothing the control output and further satisfying the stability requirements of the vehicle.
The simulation experiments of the proposed method were carried out by building a joint simulation model of CarSim and Simulink, and the final experimental results show that, compared with the traditional MPC, the proposed adaptiveness variable-parameter MPC strategy has good adaptive capability and robustness under complex working conditions, and it can greatly improve the tracking accuracy and lateral stability under the double-shifted line condition, which is of great significance for improving the adaptive and robustness of the control system of intelligent automobiles. The proposed adaptive variable-parameter MPC strategy has good adaptive capability and robustness under complex conditions.