Trajectory Tracking Control of an Agricultural Tracked Vehicle Based on Nonlinear Model Predictive Control

Accurate trajectory tracking is challenging for tracked agricultural vehicles in orchards. Uneven terrain, track slip, and vehicle posture variations are the main causes, often leading to model mismatch and degraded control performance. To address these issues, this paper proposes an improved nonlinear model predictive control (NMPC) strategy integrated with curvature feedforward compensation for trajectory tracking of tracked agricultural vehicles under uneven terrain conditions. An enhanced kinematic model based on the instantaneous center of rotation is developed by incorporating vehicle roll and pitch angles, and track slip parameters are estimated online using a Levenberg–Marquardt optimization method to improve prediction accuracy. Furthermore, curvature feedforward information derived from the reference trajectory is embedded into the NMPC objective function to provide anticipatory control inputs and reduce computational burden. Simulation results demonstrate that compared to conventional NMPC, the proposed method reduces the mean and standard deviation of tracking error by 30.28% and 32.46% respectively, while decreasing the mean and standard deviation of heading error by 37.27% and 35.05%. Concurrently, the maximum of optimize solution time is significantly reduced, effectively resolving tracking accuracy degradation caused by system solution timeouts. Field experiments conducted under different load conditions further validate that the proposed control strategy significantly reduces lateral, longitudinal, and heading tracking errors compared with conventional NMPC, confirming its effectiveness and robustness for tracked agricultural vehicle trajectory tracking in complex orchard environments.