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.
Saw rotational speed critically influences cutting force and surface quality yet is often destabilized by variable cutting resistance. The sensorless detection method for calculating rotational speed based on current ripple can prevent the contact of wood chips and dust with Hall sensors. This paper introduces a speed control system for brushed DC motors that capitalizes on the linear relationship between current ripple frequency and rotational speed. The system achieves speed regulation through indirect speed measurement and PID control. It utilizes an H-bridge circuit controlled by the EG2014S driver chip to regulate the motor direction and braking. Current ripple detection is accomplished through a 0.02 Ω sampling resistor and AMC1200SDUBR signal amplifier, followed by a wavelet transform and Savitzky–Golay filtering for refined signal extraction. Experimental results indicate that the system maintains stable speeds across the 2000–6000 RPM range, with a maximum error of 2.32% at 6000 RPM. The improved ripple detection algorithm effectively preserves critical signals while reducing noise. This enables the motor to quickly regain speed when resistance is encountered, ensuring a smooth cutting surface. Compared to traditional Hall sensor systems, this sensorless design enhances adaptability in agricultural applications.