Trajectory tracking is the core function of autonomous vehicle motion control. On variable road slopes, vehicles will encounter extra forces due to gravity, distinct from driving on flat roads. These forces will cause significant deviations in trajectory tracking and even instability, especially for four-wheel independent drive autonomous vehicles (4WIDAVs) with closely coupled longitudinal-lateral dynamics. To address above issues, first, a modified dynamics model considering coupled slopes is built, and the slope effect on vehicle motion and stability is analysed. Secondly, treating coupled slopes as augmented states, a square root cubature Kalman filter (SRCKF) is designed for real-time slope estimation. Then, a slope-adaptive model separate predictive trajectory tracking control strategy is proposed, decoupling the slope-adaptive tracking system into longitudinal and lateral subsystems. Predictive control is performed separately to ensure real-time performance, and prediction information is exchanged between subsystems to preserve dynamics coupled characteristics, enhancing tracking accuracy. Finally, the effectiveness of the proposed scheme is validated by simulations and real-vehicle experiment under the varying slope condition. Results show that the proposed scheme improves tracking accuracy by 17.59% and reduces computation time by 55.02% compared to existing scheme in simulations, and in experiment, the tracking error is reduced by 17.89%.
Read full abstract