Design and Analysis of an MPC-PID-Based Double-Loop Trajectory Tracking Algorithm for Intelligent Sweeping Vehicles

摘要

To enhance the precision and real-time performance of trajectory tracking control in differential-steering intelligent sweeping robots and to improve the adaptability of the control algorithm to errors caused by sensor noise, tire slip, and skid, an MPC-PID (Model Predictive Control–Proportional-Integral-Derivative) dual closed-loop control strategy was proposed. This strategy integrates a Kalman filter-based state estimator and a sliding compensation module. Based on the kinematic model of the intelligent sweeping robot, a model predictive controller (MPC) was designed to regulate the vehicle’s pose, while a PID controller was used to adjust the longitudinal speed, forming a dual closed-loop control algorithm. A Kalman filter was employed for state estimation, and a sliding compensation module was introduced to mitigate wheel slip and lateral drift, thereby improving the stability of the control system. Simulation results demonstrated that, compared to traditional MPC control, the maximum lateral deviation, maximum heading angle deviation, and speed response time were reduced by 50.83%, 53.65%, and 7.10%, respectively, during sweeping operations. In normal driving conditions, these parameters were improved by 41.58%, 45.54%, and 24.17%, respectively. Experimental validation on an intelligent sweeper platform demonstrates that the proposed algorithm achieves a 16.48% reduction in maximum lateral deviation and 9.52% faster speed response time compared to traditional MPC, effectively validating its enhanced tracking effectiveness in intelligent cleaning operations.