Dynamic Decoupling and Trajectory Tracking for Automated Vehicles Based on the Inverse System

: A simultaneous trajectory tracking and stability control method is present for the four-wheel independent drive (4WID) automated vehicles to handle dynamic coupling maneuvers. To conquer the disadvantage that attendant disturbances caused by the dynamic coupling of traditional decentralized control methods degenerate the trajectory tracking accuracy, the proposed method takes advantage of the idea of decoupling to optimize the tracking performance. After establishing the dynamic model of the 4WID automated vehicles, the coupling mechanism of the vehicle dynamic control and its negative e ﬀ ect on trajectory tracking were studied at ﬁrst. The inverse system model was then determined by machine learning and connected in series with the controlled object to form a pseudo linear system to realize dynamic decoupling. Finally, di ﬀ ering from previous tracking methods following the apparent lateral position and longitudinal velocity references, the pseudo linear system tracks the ideal intermediate targets transferred from the target trajectory, that is, the accelerations of vehicle in longitudinal, lateral and yaw directions, to indirectly achieve trajectory tracking and validly restrain the vehicle motion. The e ﬀ ectiveness of the proposed method, i.e., the high tracking accuracy and the stable driving performance, is veriﬁed through three coupling driving scenarios in the CarSim-Simulink co-simulations platform.


Introduction
Automated vehicles (AVs) provide safe, cheap, and efficient travel as well as attracting widespread research interest in industry and academia [1,2]. The trajectory tracking module manipulates vehicle chassis actuators to reach the target position at the right time, which is a core part of AVs and directly affects driving safety and comfort [3].
According to the different control structures, the existing trajectory tracking control can be divided into a decentralized control method and centralized control method. The decentralized control method decomposes the trajectory tracking problem into longitudinal velocity control issue and lateral position tracking issue, and the corresponding control laws of these subsystems need to be designed, respectively. In the past few decades, the problem of lateral position tracking has always been the core issue. In order to improve tracking accuracy or control stability, many lateral position tracking methods have been proposed, such as preview [4], pure-pursuit (PP) [5], Stanley [6], linear quadratic regulator (LQR) [7] and model predictive control (MPC) [8]. After being integrated with longitudinal controllers, these methods could realize accurate tracking under most scenarios [9][10][11][12]. However,

Coupling Mechanism of 4WID Vehicle
The two-track vehicle dynamic model representing the 4WID vehicle established in the Cartesian coordinate system to study the dynamic characteristics and coupling mechanism of the vehicle, as shown in Figure 1. Assuming the small steering turning, and for simplification, the steering angles of the left and right front tires are equivalent to steering angle [25]. The planar motion of the vehicle can be expressed as: = − + sin + cos + sin + cos + + , = + sin + + cos where the definition of each symbol is showed in Table A1. When the tire force differential algorithm is adopted, the longitudinal forces are synthetically considered as the total longitudinal force and the additional yaw moment [26].
where the longitudinal force distribution ratio of the front and rear axles is defined as: The additional yaw moment is caused by the longitudinal force difference ∆ between the vehicle's two sides: Then, introducing the small angle hypothesis, the tire lateral force is proportional to its slip angle [27].
The two-track model is simplified to a 3DOF model. Assuming the small steering turning, and for simplification, the steering angles of the left and right front tires are equivalent to steering angle δ [25]. The planar motion of the vehicle can be expressed as: x . ϕ + F x1 sin δ + F y1 cos δ + F x2 sin δ + F y2 cos δ + F y3 + F y4 , .
where the definition of each symbol is showed in Table A1. When the tire force differential algorithm is adopted, the longitudinal forces are synthetically considered as the total longitudinal force F t and the additional yaw moment M z [26].
where the longitudinal force distribution ratio of the front and rear axles k r is defined as: The additional yaw moment M z is caused by the longitudinal force difference ∆F between the vehicle's two sides: Then, introducing the small angle hypothesis, the tire lateral force is proportional to its slip angle [27].
y . x ϕ . x The dynamics can be rewritten in the state-space form, with the states being X = .
x, . y, . ϕ T , and the In Equation (13), the input matrix is a non-diagonal matrix, which means each state of the system is affected by multiple inputs. The input matrix is not a constant coefficient matrix, but contains input elements and state elements, which indicates that there are complex interactions among three directions and causes the attendant disturbances when controlling one of the directions, such as the −2C f δ 2 /m is a longitudinal resistance caused by lateral control input.
Once ignoring the attendant disturbance, the control errors appear and deteriorate tracking [28]: x cos e ϕ + e . y sin e ϕ , e . Y = e . y cos e ϕ − e .
x sin e ϕ ,

Methodology
Once an inverse system whose inputs and outputs are strictly opposed to the origin system exists, the decoupling method based on the inverse system will be valid, as shown in Figure 2; that is, the inverse system and the control object are connected in series to form an equivalent multiple single-input single-output combined system without interactions.
Appl. Sci. 2020, 10, x FOR PEER REVIEW 4 of 16 The dynamics can be rewritten in the state-space form, with the states being = , , , and the control inputs being = , , ,i.e., In Equation (13), the input matrix is a non-diagonal matrix, which means each state of the system is affected by multiple inputs. The input matrix is not a constant coefficient matrix, but contains input elements and state elements, which indicates that there are complex interactions among three directions and causes the attendant disturbances when controlling one of the directions, such as the −2 ⁄ is a longitudinal resistance caused by lateral control input.
Once ignoring the attendant disturbance, the control errors appear and deteriorate tracking [28]: = cos − sin ,

Methodology
Once an inverse system whose inputs and outputs are strictly opposed to the origin system exists, the decoupling method based on the inverse system will be valid, as shown in Figure 2; that is, the inverse system and the control object are connected in series to form an equivalent multiple single-input single-output combined system without interactions.

Proof of Reversibility
In order to apply the decoupling algorithm, it is necessary to prove the reversibility of the vehicle dynamic. Here, the proof is derived based on the Interactor Algorithm [29,30].
For a multiple-input and multiple-output (MIMO) nonlinear system, it can be written as where the input vector is = , … , , the state vector is = , … , and the output vector is = , … , = ℎ , ℎ … , ℎ .

Proof of Reversibility
In order to apply the decoupling algorithm, it is necessary to prove the reversibility of the vehicle dynamic. Here, the proof is derived based on the Interactor Algorithm 1 [29,30].
For a multiple-input and multiple-output (MIMO) nonlinear system, it can be written as where the input vector is U = u 1 , u 2 . . . , u p T , the state vector is X = [x 1 , x 2 . . . , x n ] T and the output vector is Y = y 1 , y 2 . . . , y q T = h 1 (X), h 2 (X) . . . , h q (X) T . Algorithm 1. Interactor Algorithm 1: Defining the superscript r k , which means taking the derivative for k-th component y k , r k is the order when control input U = u 1 , u 2 . . . , u p T firstly appears, and the derivative is noted as y Calculating the rank of the Jacobian matrix R k = rank(∂Γ k /∂U) 5: If R k = k 6: α k = r k 7: End If 8: End For The system is reversible.

11: End If
As for the proposed vehicle dynamics, the output vector is Y = .
x, . y, x, which does not include any input variable, Γ 1 needs to be rewritten with respect to its derivative [21]: that is, y .
x + 2 x , the rank of the Jacobian matrix of Γ 1 to U is So that, α 1 = r 1 = 1. And y 2 = .
y, which also does not include any input variable. Hence, y , we can get that α 2 = r 2 = 1. At last, setting and this yields α 3 = r 3 = 1, then According to the reversibility judgment [31], there is an inverse system for the 4WID vehicle without hidden dynamics [32], and the input and output of the inverse system are U inv = y (1) As the 3DOF vehicle dynamic system is reversible and based on the Equation (13), the inverse system can be written as Equation (22): x −2

Definition of the Inverse System
As shown in Equation (22), the output can be calculated using the Taylor series expansion. However, to avoid the approximation error caused by the omission of high-order terms in the Taylor formula, a machine learning method is applied to identify the relationship between the input and output of the system in this paper. Because the identification of the inverse system is a MIMO regression, the back propagation neural network (BPNN) model is adopted. Note that ..
x and .. y are replaced by the measurable a x and a y : .. ..
Hence, the input and output of the BPNN model are U nn = a x , a y ,

Neural Networks Training
The D-class sedan model of CarSim is utilized to obtain the vehicle responses a x , a y , To simulate the 4WID vehicle, the total longitudinal force and yaw moment are converted to driven torques of each wheel based on Equations (2) and (4).
where T f l , T f l , T f l , T f l are the driven torques of the front-left, front-right, rear-left and rear-right tire, respectively. r is the radius of each wheel. I r is the wheel inertia moment. w f l, f r and w f l, f r are the rotation velocities of each wheel. The longitudinal and lateral acceleration were constrained considering the ride comfort and anti-sideslip [33].
− µ s g ≤ a y ≤ µ s g, where η d , η and µ s respectively represent the maximum coefficient of longitudinal deceleration, longitudinal acceleration and lateral acceleration. According to the vehicle dynamics and the kinematic model: where R is the turning radius of the vehicle, and L is the distance between the front and rear axles. Then, substituting Equations (29) and (30) into Equations (27) and (28) yields: The interval between two sampling points of longitudinal force, steering angle and additional yaw moment is 2 s. The values of sampling points are stochastically generated, obeying the uniform distribution in the range of (−5000, 5000)N, (−0.1, 0.1)rad and (−500, 500)Nm, respectively. The sampling data are interpolated by the Hermite method for smoothness, as shown in Figure 3. where , and respectively represent the maximum coefficient of longitudinal deceleration, longitudinal acceleration and lateral acceleration. According to the vehicle dynamics and the kinematic model: where is the turning radius of the vehicle, and is the distance between the front and rear axles. Then, substituting Equations (29) and (30) into Equations (27) and (28) yields: The interval between two sampling points of longitudinal force, steering angle and additional yaw moment is 2 s. The values of sampling points are stochastically generated, obeying the uniform distribution in the range of −5000,5000 , −0.1,0.1 and −500,500 , respectively. The sampling data are interpolated by the Hermite method for smoothness, as shown in Figure 3. By setting different initial speeds, multiple groups of input signals act on the vehicle model, then the inputs and the responses of the vehicle are recorded as the training dataset. To ensure the validity of the collected data set, the following two constraints need to be guaranteed.

•
The equivalent steering angle is constrained according to the real-time speed.

•
The vehicle speed is always positive.

Design of the Trajectory Tracking Controller
Based on the inverse system, the control framework is built in Figure 4. The target motion trajectory transformed into the vehicle dynamic state references-that is, the longitudinal acceleration, the lateral acceleration, and the yaw acceleration. By following the target vehicle dynamic state, the inverse system exports the vehicle inputs and drives the vehicle tracking desired trajectory. By setting different initial speeds, multiple groups of input signals act on the vehicle model, then the inputs and the responses of the vehicle are recorded as the training dataset. To ensure the validity of the collected data set, the following two constraints need to be guaranteed.

•
The equivalent steering angle is constrained according to the real-time speed.

•
The vehicle speed is always positive.

Design of the Trajectory Tracking Controller
Based on the inverse system, the control framework is built in Figure 4. The target motion trajectory transformed into the vehicle dynamic state references-that is, the longitudinal acceleration, the lateral acceleration, and the yaw acceleration. By following the target vehicle dynamic state, the inverse system exports the vehicle inputs and drives the vehicle tracking desired trajectory.

The desired Vehicle States
Based on the kinematic model, the desired vehicle states, i.e., the references of the inverse system = , , , are calculated from the target motion trajectory.
Supposing that the references from the planning module are the sequences of resultant speed and trajectory , is the time, and are the vehicle longitudinal and lateral position in the inertial coordinate system.
The spatial-temporal relationship is unified by using the travel distance of vehicles [34].
where ∆ and ∆ are the longitudinal and lateral spacing between the + 1th point and the th point in the inertial coordinate system.
The desired yaw can be calculated as [35]: The vehicle velocity along the and directions in the inertial coordinate system are Then, the vehicle longitudinal and lateral velocities are [28] = cos + ∆ sin , The longitudinal, lateral and yaw accelerations are yields: So far, the input of the inverse system, the target motion states of the vehicle = , , , has been obtained.

The Desired Vehicle States
Based on the kinematic model, the desired vehicle states, i.e., the references of the inverse system U re f = a x , a y , .. ϕ , are calculated from the target motion trajectory. Supposing that the references from the planning module are the sequences of resultant speed V(t) and trajectory Y(X), t is the time, X and Y are the vehicle longitudinal and lateral position in the inertial coordinate system.
The spatial-temporal relationship is unified by using the travel distance of vehicles [34].
where ∆X(i) and ∆Y(i) are the longitudinal and lateral spacing between the i + 1 th point and the i th point in the inertial coordinate system. The desired yaw can be calculated as [35]: The vehicle velocity along the X and Y directions in the inertial coordinate system are Then, the vehicle longitudinal and lateral velocities are [28] . .
The longitudinal, lateral and yaw accelerations are yields: ..
So far, the input of the inverse system, the target motion states of the vehicle U re f = a x , a y , .. ϕ T , has been obtained.

Simulation Results and Analysis
The simulations are conducted to verify the correctness of the inverse system identification and assess the tracking performance of the proposed method. A D-Class CarSim vehicle model is adopted, and the parameters are shown in Table A2. The proposed trajectory tracking controller is developed in Simulink. The Simulink-CarSim interface is shown in Figure 4.

Verification of the Inverse System Models
The inverse system is identified by a BPNN model whose structure is 6-50-50-3, i.e., the model has six inputs, three outputs and two hidden layers with 50 nodes. The mean square error between the training data and the prediction of the BPNN is 0.000213 and the regression factor of the model is 0.99941, which indicates that the model has identified the input-output mapping relationship between the of the inverse system. A novel test dataset was collected and applied to evaluate the fitting performance of the inverse system as Figure 5.

Simulation Results and Analysis
The simulations are conducted to verify the correctness of the inverse system identification and assess the tracking performance of the proposed method. A D-Class CarSim vehicle model is adopted, and the parameters are shown in Table A2. The proposed trajectory tracking controller is developed in Simulink. The Simulink-CarSim interface is shown in Figure 4.

Verification of the Inverse System Models
The inverse system is identified by a BPNN model whose structure is 6-50-50-3, i.e., the model has six inputs, three outputs and two hidden layers with 50 nodes. The mean square error between the training data and the prediction of the BPNN is 0.000213 and the regression factor of the model is 0.99941, which indicates that the model has identified the input-output mapping relationship between the of the inverse system. A novel test dataset was collected and applied to evaluate the fitting performance of the inverse system as Figure 5.  Figure 5, three responses of the BPNN model highly coincide with the actual value, illustrating that the identification of the inverse system is correct and the 4WID vehicle system is reversible.

Verification of Tracking Performance
Three coupling scenarios were designed to assess the tracking performance, and pure-pursuit and MPC are implemented as the benchmark to compare the improvement of the proposed method. Note that, to filter out the varying-velocity disturbance, the lateral preview reference of MPC and pure-pursuit is based on time, and a speed preview controller supplemented in parallel.

Scenario 1: Lane Change with Deceleration on Dry Road Surface
In this scenario, the vehicle drives at the initial speed of 90 km/h on a straight and dry road with the road adhesion coefficient being 0.8, then the decelerating lane change is completed within 58 m, which is a classic collision avoidance scenario.
Based on the proposed method, the desired vehicle motion states = , , were calculated and the vehicle dynamic states tracking results are shown as Figure 6.  Figure 5, three responses of the BPNN model highly coincide with the actual value, illustrating that the identification of the inverse system is correct and the 4WID vehicle system is reversible.

Verification of Tracking Performance
Three coupling scenarios were designed to assess the tracking performance, and pure-pursuit and MPC are implemented as the benchmark to compare the improvement of the proposed method. Note that, to filter out the varying-velocity disturbance, the lateral preview reference of MPC and pure-pursuit is based on time, and a speed preview controller supplemented in parallel.

Scenario 1: Lane Change with Deceleration on Dry Road Surface
In this scenario, the vehicle drives at the initial speed of 90 km/h on a straight and dry road with the road adhesion coefficient being 0.8, then the decelerating lane change is completed within 58 m, which is a classic collision avoidance scenario.
Based on the proposed method, the desired vehicle motion states U re f = a x (t), a y (t), ..

ϕ(t)
T were calculated and the vehicle dynamic states tracking results are shown as Figure 6.  Figure 6 shows that the longitudinal acceleration, lateral acceleration of the vehicle coincide with the desired value and the change in each direction does not affect the other directions, indicating that the proposed method has decoupled dynamics and the vehicle dynamic states can be accurately tracked in close loop.
As shown in Figure 7, the real vehicle velocity and lateral position accurately follow the references. The velocity tracking error of the proposed method is smallest compared with pure-pursuit control and MPC. With the same longitudinal controller, MPC and pure-pursuit control still contribute to different speed errors, which means the longitudinal control is affected by control in other directions. Even though the lateral control value was correctly calculated by MPC, the longitudinal tracking error results in a delay in the lateral tracking owning to the lateral reference related to the time and does not consider the longitudinal error within a planning cycle, which is another deterioration of tracking accuracy caused by dynamic coupling.  As shown in Figure 7, the real vehicle velocity and lateral position accurately follow the references. The velocity tracking error of the proposed method is smallest compared with pure-pursuit control and MPC. With the same longitudinal controller, MPC and pure-pursuit control still contribute to different speed errors, which means the longitudinal control is affected by control in other directions. Even though the lateral control value was correctly calculated by MPC, the longitudinal tracking error results in a delay in the lateral tracking owning to the lateral reference related to the time and does not consider the longitudinal error within a planning cycle, which is another deterioration of tracking accuracy caused by dynamic coupling.
To quantitatively evaluate the tracking performance of the three methods, the results were statistically analyzed.
The statistical values of lateral error are shown in Table 1. Compared with pure-pursuit and MPC, the mean square error of velocity (MSE V ) of the proposed method is the smallest, and its mean square error of lateral tracking (MSE Y ) and yaw tracking (MSE yaw ) rank in the middle.  Figure 6. The vehicle dynamic states tracking results in scenario 1. Figure 6 shows that the longitudinal acceleration, lateral acceleration of the vehicle coincide with the desired value and the change in each direction does not affect the other directions, indicating that the proposed method has decoupled dynamics and the vehicle dynamic states can be accurately tracked in close loop.
As shown in Figure 7, the real vehicle velocity and lateral position accurately follow the references. The velocity tracking error of the proposed method is smallest compared with pure-pursuit control and MPC. With the same longitudinal controller, MPC and pure-pursuit control still contribute to different speed errors, which means the longitudinal control is affected by control in other directions. Even though the lateral control value was correctly calculated by MPC, the longitudinal tracking error results in a delay in the lateral tracking owning to the lateral reference related to the time and does not consider the longitudinal error within a planning cycle, which is another deterioration of tracking accuracy caused by dynamic coupling. To quantitatively evaluate the tracking performance of the three methods, the results were statistically analyzed.

Scenario 2: Turn Left with Deceleration at Crossing
In urban traffic, the intersection is a common scene. The vehicle is required to slow down through a right-angle bend with a radius of 50 m. On a dry road with a road adhesion coefficient of 0.8, the vehicle speed decelerates to 9 m/s from 12 m/s within 5 s. Figure 8 shows that there are two big pulses in the target . w r which are caused by the noncontinuous curvature. As the pulses with large rates of change exceeded the range of the training set, the target . w r was difficult to track and resulted in a chain reaction in the longitudinal and lateral directions. However, the longitudinal and lateral fluctuations accompanied by yaw pulses do not mean decoupling failure, because besides the fluctuating part, the other targets in the three motion directions are accurately tracked without interferences. This gives us two inspirations; first, the target vehicle motion states should be smooth and remain within the range of the training set; the other is that the curvature of the target position curve designed by the planning level should be as continuous as possible. Figure 9 shows that the proposed method realizes the velocity, position and yaw tracking simultaneously. The fluctuations in a x and a y are amplified and accumulated, resulting in a stable velocity and lateral error of 0.193 km/h and 0.36 m after a 150 m trip. As the lateral error is seriously related to driving safety, the tracking performance of pure-pursuit is the best in this scenario. The MPC failed to reduce the error in the X direction of the Cartesian coordinate system without coordinate transformation, which leads to a larger lateral error in the vehicle coordinate system. Figure 9 shows that the proposed method realizes the velocity, position and yaw tracking simultaneously. The fluctuations in and are amplified and accumulated, resulting in a stable velocity and lateral error of 0.193 km h ⁄ and 0.36 m after a 150 m trip. As the lateral error is seriously related to driving safety, the tracking performance of pure-pursuit is the best in this scenario. The MPC failed to reduce the error in the X direction of the Cartesian coordinate system without coordinate transformation, which leads to a larger lateral error in the vehicle coordinate system.

Scenario 3: Lane Change with Deceleration/Acceleration on a Wet Road Surface
In scenario 3, the vehicle decelerates or accelerates at the initial speed of 20 m/s when changing lane on a wet road whose road adhesion coefficient is 0.35. Figure 10a shows that the three methods all still achieve trajectory tracking on a low-adhesion road. Compared with Figure 7, even though the road conditions are worse, the lateral and yaw tracking errors of the proposed method decrease with speed reduction. However, the lateral and yaw tracking performance of the MPC get worse. In Figure 10b, the pure-pursuit and MPC fail to track the target in longitudinal, lateral and yaw motion. However, the proposed method still follows the constrained vehicle states at the lower-adhesion road condition, guaranteeing the driving stability.

Scenario 3: Lane Change with Deceleration/Acceleration on a Wet Road Surface
In scenario 3, the vehicle decelerates or accelerates at the initial speed of 20 m/s when changing lane on a wet road whose road adhesion coefficient is 0.35. Figure 10a shows that the three methods all still achieve trajectory tracking on a low-adhesion road. Compared with Figure 7, even though the road conditions are worse, the lateral and yaw tracking errors of the proposed method decrease with speed reduction. However, the lateral and yaw tracking performance of the MPC get worse. In Figure 10b, the pure-pursuit and MPC fail to track the target in longitudinal, lateral and yaw motion. However, the proposed method still follows the constrained vehicle states at the lower-adhesion road condition, guaranteeing the driving stability. Figure 10a shows that the three methods all still achieve trajectory tracking on a low-adhesion road. Compared with Figure 7, even though the road conditions are worse, the lateral and yaw tracking errors of the proposed method decrease with speed reduction. However, the lateral and yaw tracking performance of the MPC get worse. In Figure 10b, the pure-pursuit and MPC fail to track the target in longitudinal, lateral and yaw motion. However, the proposed method still follows the constrained vehicle states at the lower-adhesion road condition, guaranteeing the driving stability. As we can see from Figure 11a, the proposed method always keeps the vehicle in the safe area of the sideslip phase-plane like the pure-pursuit and MPC; however, in Figure 11b, since the tracking performance becomes worse, the phase curve of the pure-pursuit and MPC are over the stability As we can see from Figure 11a, the proposed method always keeps the vehicle in the safe area of the sideslip phase-plane like the pure-pursuit and MPC; however, in Figure 11b, since the tracking performance becomes worse, the phase curve of the pure-pursuit and MPC are over the stability boundaries, which means that the proposed method significantly improves the handling stability and has fewer tracking errors compared with the pure-pursuit and MPC algorithms.
Appl. Sci. 2020, 10, x FOR PEER REVIEW 13 of 16 boundaries, which means that the proposed method significantly improves the handling stability and has fewer tracking errors compared with the pure-pursuit and MPC algorithms.  Figure 12 shows the error statistics results of the longitudinal, lateral and yaw directions of the three tracking controllers under four working conditions, as well as the trajectory tracking error index of the planar motion weighted by the three directions. Figure 11. The sideslip phase-plane diagram: (a) steering with deceleration; (b) steering with acceleration. Figure 12 shows the error statistics results of the longitudinal, lateral and yaw directions of the three tracking controllers under four working conditions, as well as the trajectory tracking error index P of the planar motion weighted by the three directions. Figure 12 shows the error statistics results of the longitudinal, lateral and yaw directions of the three tracking controllers under four working conditions, as well as the trajectory tracking error index of the planar motion weighted by the three directions. Considering that three directions are equally important in planar motion tracking, the three weights should be the same. However, due to the unit, the mean square error of yaw tracking is very large, so it is reduced by a certain proportion and the weighted vector is = 1,1, /180 . Figure 12a, except for scenario 2, the of the proposed method is the smallest. The accurate velocity tracking illustrates that the dynamic decoupling of the proposed tracking method can effectively reduce the longitudinal interference from other motion directions. Moreover, compared with the other two methods, the proposed method still performs well in the lateral and Considering that three directions are equally important in planar motion tracking, the three weights should be the same. However, due to the unit, the mean square error of yaw tracking is very large, so it is reduced by a certain proportion and the weighted vector is w = (1, 1, pi/180) T .

As shown in
As shown in Figure 12a, except for scenario 2, the MSE V of the proposed method is the smallest. The accurate velocity tracking illustrates that the dynamic decoupling of the proposed tracking method can effectively reduce the longitudinal interference from other motion directions. Moreover, compared with the other two methods, the proposed method still performs well in the lateral and yaw tracking. In summary, as shown in Figure 12d, the trajectory tracking error index of the proposed method proposed is always the lowest, indicating that the proposed tracking method is more suitable for performing trajectory tracking tasks under the coupled conditions than the other two methods.

Conclusions
To achieve the high trajectory tracking precision in the dynamic coupling scenarios, a simultaneous trajectory tracking and stability control method for 4WID automated electric vehicles is present in this paper based on the inverse system theorem. To reveal the coupling mechanism and to prove the reversibility of 4WID vehicles, the 3DOF vehicle dynamic model is constructed. The inverse system learned by a BPNN model shows effectiveness to realize dynamic decoupling. The pseudo linear system composed of the inverse system and the controlled object follows the desired vehicle dynamic states to indirectly achieve trajectory tracking. Three typical and common coupled driving conditions are designed to verify the trajectory tracking accuracy under the simultaneous control of vehicles' longitudinal, lateral and yaw motion. Compared with the pure-pursuit algorithm and the MPC algorithm, the proposed method reduces interactions among vehicle motion directions and reveals better tracking performance. Moreover, since the target states of the vehicle have been constrained within a reasonable range, the decoupling method not only maintains the accurate trajectory tracking but also guarantees the stable vehicle driving under low-adhesion road conditions. Even though the proposed method theoretically shows better control performance, further verifications could be implemented on real vehicles to realize the engineering applications. Acknowledgments: In this section you can acknowledge any support given which is not covered by the author contribution or funding sections. This may include administrative and technical support, or donations in kind (e.g., materials used for experiments).

Conflicts of Interest:
We declare that there is no conflict of interests in connection with the paper submitted.