- 1Institute of Modern Agricultural Equipment, Xihua University, Chengdu, China
- 2Inner Mongolia Academy of Agricultural and Animal Husbandry Sciences, Hohhot, China
Introduction: Tracked agricultural vehicles operating in complex farmland environments are prone to track slip, which degrades path-tracking accuracy and may lead to unstable motion. To address the limitations of conventional geometric tracking algorithms under slip conditions, this study proposes a slip-aware look-ahead point offset path-tracking control method for tracked agricultural machinery.
Methods: An extended Kalman filter (EKF) is developed to fuse RTK–IMU pose measurements with track wheel-speed feedback, enabling real-time estimation of left and right track slip ratios. Based on the estimated slip difference, a target-point offset compensation mechanism is constructed, and the offset angle is optimized online using an improved particle swarm optimization (PSO) algorithm with a Chebyshev-window-based inertia weight strategy. In addition, a fuzzy controller is employed to adaptively adjust the look-ahead distance according to vehicle speed and path curvature, while a first-order low-pass filter is applied to smooth the commanded velocities.
Results: Simulation results demonstrate that the proposed method significantly reduces lateral tracking errors and maintains smooth trajectories under severe slip conditions. Field experiments conducted at speeds of 0.35 m/s and 0.75 m/s show that the proposed method reduces the maximum lateral deviation by 78.1% and the average deviation by 50.6% compared with the traditional fuzzy pure pursuit algorithm. At 0.75 m/s, the maximum and average deviations are further reduced by 63.1% and 57.6%, respectively.
Discussion: The results confirm that incorporating slip estimation and slip-aware target-point offset compensation effectively enhances path-tracking accuracy and robustness for tracked agricultural vehicles operating on soft and high-slip terrain. The proposed lightweight control framework provides a practical and reliable solution for autonomous navigation and plant-protection operations in complex farmland environments.
1 Introduction
With the advancement of agricultural modernization and intelligence, the issues of autonomous navigation and path tracking for tracked agricultural machinery in complex farmland environments have attracted increasing attention (Sun et al., 2024). As a critical component of unmanned agricultural operations, path tracking control directly influences both the operational quality and overall efficiency (Zhang et al., 2020; Shi et al., 2023; Chen and Wang, 2024). However, due to the soft terrain and complex adhesion conditions typically encountered in farmland operations, tracked vehicles inevitably experience varying degrees of slip during motion. This slip causes deviations between the actual trajectory and the desired path and may even lead to control instability (Jiao et al., 2018; Zhao et al., 2024). Therefore, achieving high-accuracy and robust path tracking control under slip disturbances has become an urgent research challenge.
A substantial amount of research has been conducted on path tracking control for agricultural machinery both domestically and internationally (Wang et al., 2019; Liu et al., 2023; Xu et al., 2023; Liu et al., 2025b). Classical approaches such as the Pure Pursuit and Stanley algorithms have been widely adopted due to their simple structure and good real-time performance. Zhang et al (Zhang et al., 2024) proposed an integral-compensation fuzzy Pure Pursuit method based on B-spline path optimization, where path interpolation and fuzzy adaptive adjustment of the look-ahead distance effectively reduced lateral deviation during curved-path tracking. Song et al (Song et al., 2025) employed the sparrow search algorithm to adaptively tune the look-ahead distance, achieving average lateral and heading errors of 0.03 m and 0.275°, respectively. Cui et al (Cui et al., 2022) developed an improved Stanley model incorporating fuzzy inference, in which the control gain is adjusted in real time based on lateral and heading errors, thereby enhancing curve-segment tracking accuracy and adaptability in full-field agricultural operations. Wang et al (Wang et al., 2022) proposed an improved Stanley controller (IMP-ST) and optimized its parameters using a multi-population genetic algorithm (MPGA), resulting in a 48.61% improvement in tracking performance. In addition to control-oriented improvements, researchers have also explored robust path planning frameworks for agricultural robots. Yang et al. proposed AgriPath, a multi-objective path planning framework designed for dynamic field environments, which integrates multimodal perception and optimization techniques to enhance the adaptability and safety of agricultural robot navigation (Yang et al., 2025).
However, such methods generally assume no slip, leading to a significant decline in tracking accuracy under actual farmland conditions. Path tracking approaches based on model predictive control (MPC) can account for vehicle dynamics and operational constraints to some extent, but their high computational complexity makes it difficult to meet the real-time requirements of agricultural operations (Bai et al., 2020). He et al (He et al., 2022) developed an MPC-based path controller using attitude measurements in paddy fields, achieving an average absolute error of 0.033 m in field experiments. In recent years, MPC has also attracted increasing attention in autonomous driving and mobile robot navigation due to its capability of handling multivariable constraints and nonlinear dynamics.
Recent studies have shown that MPC-based frameworks can achieve outstanding tracking precision and strong robustness even under high-dynamic or constrained operating conditions. For instance, Guo et al (Guo et al., 2025) demonstrated that a Lyapunov-based nonlinear MPC formulation can provide highly stable and accurate trajectory tracking for distributed-drive electric vehicles, effectively ensuring handling performance under complex dynamic interactions. Similarly, Wang and Xiong developed a coupled MPC controller for four-wheel-steering vehicles and verified its capability in coordinating multi-degree-of-freedom motions while maintaining high tracking accuracy in dynamic scenarios. These works collectively highlight the advantages of MPC in constrained planning and control. Nevertheless, despite these strengths, the computational burden of MPC remains a major obstacle for real-time deployment on lightweight agricultural platforms.
In addition, some researchers have attempted to improve control accuracy through slip modeling and compensation (Jiao et al., 2015), such as incorporating Kalman filtering (Qian et al., 2024)or applying fuzzy controllers for adaptive adjustment (Zhang et al., 2021). Li et al (Li et al., 2023) proposed an adaptive temporal regulation strategy for orchard scenarios, achieving tracking errors within 5 cm in field tests. Nevertheless, the compensation capability of existing methods remains limited under complex slip conditions.
To address the above issues, this study proposes a slip-aware look-ahead point offset path tracking control method for tracked agricultural machinery. In the method design, a fuzzy controller is first developed to adaptively adjust the look-ahead distance, accommodating the response characteristics of the Pure Pursuit algorithm under varying speeds and path curvatures. It is worth noting that fuzzy control has been widely applied in path tracking research (Li et al., 2013), and its introduction here serves as a commonly used baseline optimization rather than the core innovation of this work. Building on this, an extended Kalman filter integrating RTK–IMU measurements with track wheel-speed feedback is constructed to estimate the slip ratios of the left and right tracks in real time. Subsequently, a target-point offset compensation mechanism is innovatively proposed, which takes the differential slip ratio between the two tracks as the input, while an improved particle swarm optimization algorithm is employed to obtain the optimal offset angle, thereby enhancing control accuracy and robustness under slip conditions. In addition, a first-order low-pass filter is incorporated into the velocity control loop to improve the smoothness of the commanded signals. Simulation and field experiments are conducted to validate the path tracking accuracy and stability of the proposed algorithm in complex farmland environments.
The main contributions of this work are summarized as follows:
1. A slip-aware look-ahead point offset mechanism is proposed to compensate for trajectory deviation under asymmetric track slip. The offset angle is optimized by an improved PSO algorithm with a Chebyshev-window-based inertia weight strategy.
2. An extended Kalman filter integrating RTK–IMU pose data with track wheel-speed feedback is developed to estimate the left–right track slip ratios in real time, providing reliable slip-state perception for the controller.
3. A complete lightweight path-tracking control framework is constructed by combining adaptive look-ahead tuning, slip estimation, offset compensation, and velocity filtering. Both simulation and field experiments verify the accuracy, robustness, and engineering feasibility of the proposed method under complex farmland conditions.
The remainder of this paper is organized as follows. Section 2 introduces the system modeling and overall control framework. Section 3 presents the design of the key algorithms, including the adaptive look-ahead strategy, slip estimation, and offset optimization. Section 4 provides simulation and experimental validation. Section 5 concludes the paper and discusses future research directions.
2 Overall design of the path tracking system
To achieve stable path tracking control for tracked agricultural machinery in complex farmland environments, a complete control system architecture must be established, covering vehicle modeling, target-point computation, and controller design. This section focuses on the design of the path tracking system, beginning with the kinematic modeling of the tracked vehicle, followed by an introduction to the classical Pure Pursuit control method. An improved path tracking control framework incorporating slip-awareness is then presented to address the limitations of conventional approaches under slip conditions.
2.1 Kinematic model of the tracked agricultural vehicle
Before designing the path tracking control algorithm, it is necessary to establish the kinematic model of the tracked agricultural vehicle to characterize its pose evolution and provide a theoretical basis for controller development (Liu et al., 2025a). The tracked vehicle performs steering through differential driving of the left and right tracks, and based on its structural characteristics, it can be abstracted as a typical differential-drive model. For the convenience of modeling and analysis, the following reasonable assumptions are made for the tracked vehicle:
a. The vehicle is regarded as a rigid-body system, and elastic deformation during motion is not considered; the center of mass is assumed to remain fixed at the midpoint of the chassis.
b. The motion of the vehicle is constrained to a horizontal plane, where only planar translation and rotation about the vertical axis are considered.
c. The vehicle adopts a differential steering mechanism, and turning is achieved by controlling the linear velocity difference between the left and right tracks; elastic coupling and asymmetric wear between the two tracks are not considered.
d. In the basic model described in this section, lateral sideslip is assumed to be absent, and the velocity of the center of mass is aligned with the longitudinal axis of the vehicle. In subsequent sections, slip ratio parameters and estimation models will be introduced based on this fundamental model to better approximate real operating conditions.
The kinematic schematic is illustrated in Figure 1, where the vehicle’s center of mass is defined as the reference point C. A body-fixed coordinate frame (x, y) is established, and the heading angle θ is defined as the angle between the body-frame x-axis and the ground-fixed X-axis. The linear velocities of the left and right tracks are denoted as vL"and vR, respectively. The forward velocity of the vehicle’s center of mass along the body-frame longitudinal axis is represented by vc, and the angular velocity of the vehicle is denoted as ω.
The velocity of the vehicle’s center of mass is obtained as the average of the left and right track velocities, while the angular velocity is generated by their velocity difference. The expressions are given as shown in Equation 1.
Accordingly, the rate of change of the vehicle’s position in the global coordinate frame and the rate of change of its heading angle can be expressed as shown in Equation 2.
2.2 Pure pursuit tracking model
The Pure Pursuit algorithm is a geometry-based path tracking method whose core idea is to steer the vehicle toward a target point located ahead on the reference path (Hu et al., 2024). For tracked agricultural machinery, the Pure Pursuit controller is combined in this study with the differential-drive kinematic model to derive the control formulas for the left and right track velocities. As illustrated in Figure 2:
Assuming that the current position of the vehicle’s center of mass is (xC, yC) with a heading angle θ, the current look-ahead distance is Ld, and the target point position is (xt, yt), the direction from the vehicle to the target point can be expressed as shown in Equation 3.
Accordingly, the yaw error between the vehicle and the target point is given as shown in Equation 4.
The vehicle turns with a radius R around the circumscribed circle passing through the target point, and the distance between the target point and the vehicle’s center of mass is the look-ahead distance Ld. According to the geometric relationship, Equation 5 can be obtained.
According to the definition of the turning radius for a tracked vehicle, the relationship between the angular velocity and the turning radius is given as shown in Equation 6.
Substituting Equation 5 into the corresponding expression yields Equation 7.
When the vehicle exhibits angular velocity, the two tracks rotate about the same instantaneous center of curvature (ICC) with respect to the vehicle’s center of mass. The rotational radii of the left and right tracks are given as shown in Equation 8.
Accordingly, the velocities of the left and right tracks can be expressed as shown in Equation 9.
Substituting Equation 7 into the corresponding expression yields Equation 10.
2.3 Structure of the slip-aware path tracking control system
The traditional Pure Pursuit algorithm can achieve satisfactory path tracking performance under the ideal assumption of no slip. However, in soft and complex farmland terrain, tracked vehicles inevitably experience varying degrees of slip on the left and right tracks, resulting in deviations between the actual and desired trajectories and potentially causing system divergence (Zhao et al., 2025). Therefore, based on the Pure Pursuit controller, this study proposes an improved path tracking control system that incorporates a slip-aware mechanism.
The proposed system integrates multiple modules, including an extended Kalman filter, a fuzzy controller, an improved particle swarm optimization algorithm, and a Pure Pursuit controller. The overall control flow is shown in Figure 3. First, the fuzzy controller takes the curvature of the reference path ahead and the vehicle speed as inputs to determine an appropriate look-ahead distance. Then, the extended Kalman filter estimates the slip ratios of the left and right tracks, sL"and sR, based on the vehicle states and the motor speed feedback from the motor controller. Next, the improved particle swarm optimization algorithm uses this information to compute the optimal offset angle δ for the current look-ahead point. The Pure Pursuit algorithm then calculates the velocities of the left and right tracks according to the corrected look-ahead point, and a low-pass filter is applied to suppress unnecessary oscillations. Finally, the commanded velocities of the left and right tracks are sent to the chassis actuators, forming a closed-loop perceive–optimize–control process that continues until the look-ahead point reaches the end of the reference path, at which point the procedure terminates.
To further illustrate the role of the look-ahead target point offset compensation mechanism under track slip conditions, Figure 4 presents the trajectory variations under different control strategies. In the figure, the green line represents the ideal vehicle trajectory, the blue line indicates the trajectory with slip-induced deviation, and the red line shows the actual trajectory obtained after applying the target-point offset δ. It can be clearly observed that by adjusting the target point, the controller is indirectly guided to generate velocity commands that better conform to the theoretical trajectory, thereby improving the vehicle’s adaptability to track slip.
3 Design of key algorithms
3.1 Adaptive look-ahead distance strategy based on fuzzy control
In Pure Pursuit–based path tracking control, the selection of the look-ahead distance Ld plays a crucial role in determining control accuracy and system stability (Chen et al., 2024). To meet the dynamic control requirements under varying speeds and path geometric complexities, an adaptive look-ahead distance adjustment mechanism based on fuzzy control is designed. This mechanism enables automatic tuning of Ld during vehicle operation, thereby enhancing the system’s environmental adaptability and control robustness.
The designed fuzzy controller adopts a two-input, single-output structure. The input variables include the current linear velocity v of the vehicle, defined within the range [0, 2.5] and divided into three levels, and the average curvature k of the path ahead, defined within the range [0, 0.6] and also divided into three levels. The output variable is the adaptive look-ahead distance Ld, with an output range of [0.6, 2.5] and divided into five levels. All variables are represented using triangular membership functions, as shown in Figure 5.
The velocity range [0, 2.5] was selected according to the maximum operating speed of the test platform in both simulation and field experiments. The curvature range [0, 0.6] was determined based on the curvature statistics of the reference path, which covers the typical turning radii observed in agricultural trajectories. These ranges ensure that the fuzzy controller operates within the actual dynamic limits of the vehicle.
Based on the response characteristics of path tracking, nine fuzzy control rules are designed. The fuzzy rule table is shown in Table 1, and the corresponding rule surfaces are illustrated in Figure 6.
3.2 Design of the slip-aware target-point offset mechanism
To realize the slip-aware target-point offset mechanism, the key lies in accurately acquiring slip information during vehicle operation and adjusting the control strategy accordingly. The mechanism consists of two main components. First, an extended Kalman filter (EKF) is employed to estimate the slip ratios of the left and right tracks in real time, which serve as critical indicators of ground adhesion conditions. Second, guided by the difference in slip ratios, a target-point offset angle δ is introduced. An objective function is constructed based on this slip information, and an improved particle swarm optimization (PSO) algorithm—enhanced with a Chebyshev-window-based weight attenuation strategy—is utilized to iteratively obtain the optimal offset angle δ for the current operating condition.
3.2.1 Estimation of left and right track slip ratios based on the extended Kalman filter
To achieve online estimation of the slip ratios of the left and right tracks, a state estimation algorithm based on the extended Kalman filter (EKF) is designed. This method considers the slip characteristics of tracked agricultural machinery by fusing pose measurements from RTK-GNSS and the IMU with the commanded track velocities. A nonlinear state transition model is constructed, and the slip ratios are inferred through the observation residuals, thereby enabling slip-state perception without requiring additional sensors.
The system state vector is defined as follows, as given in Equation 11:
where x and y represent the position of the vehicle’s center of mass in the global coordinate frame, θ denotes the heading angle, and sL and sR are the slip ratios of the left and right tracks, respectively.
The control inputs are obtained from the motor controller in the form of the rotational speeds of the left and right drive motors, denoted as nL"and nR (unit: r/min). The motor speeds are transmitted to the tracks through the vehicle’s reduction mechanism and the drive sprockets, generating the corresponding track linear velocities. According to the relationship between the wheel rotational speed and the track linear velocity, the ideal linear velocities of the left and right tracks are given by Equation 12:
where r is the radius of the drive sprocket, and i is the transmission ratio between the motor shaft and the drive sprocket.
Therefore, the control input vector of the extended Kalman filter is given by Equation 13:
The filter predicts the vehicle’s current position and orientation by combining the previous state estimate with the wheel-speed information through the nonlinear kinematic model, thereby providing a reasonable prior state estimate for the update step.
Considering the influence of slip on the actual track velocities, the actual velocities of the left and right tracks can be expressed as Equation 14:
Accordingly, the actual linear velocity of the vehicle’s center of mass and its angular velocity can be expressed as shown in Equation 15:
Substituting these expressions into the prediction model yields the state prediction at time step k as given in Equation 16:
In this formulation, the slip ratios are treated as slow-varying variables and are therefore not updated during the prediction step; instead, they are corrected only during the measurement update phase.
By linearizing the state transition function with respect to the state variables, the Jacobian matrix F is obtained. With the process noise covariance denoted as Q, the predicted state covariance can be expressed as Equation 17:
After completing the state prediction, the extended Kalman filter updates the predicted state using the sensor measurements at the current time step. By comparing the predicted values with the actual observations (i.e., the measurement residual) and incorporating the uncertainty information represented by the covariance matrices, the filter computes the optimal state estimate. This process enables dynamic tracking of the vehicle’s actual state.
The observation vector of the extended Kalman filter is provided by the fusion of RTK-GNSS and IMU measurements, and includes the vehicle’s two-dimensional position and heading angle in the global coordinate frame, as shown in Equation 18:
The observation model can be expressed as Equation 19:
where vk"is the measurement noise, assumed to follow a zero-mean Gaussian distribution with covariance R. The observation matrix H is defined as shown in Equation 20:
The measurement residual is constructed from the difference between the current predicted observation and the actual measurement at time step, as given in Equation 21:
where the residual of the heading angle requires angle normalization, as shown in Equation 22:
The Kalman gain is computed as given in Equation 23:
The state estimate is updated as shown in Equation 24:
The covariance matrix is updated as shown in Equation 25:
The process noise matrix Q and measurement noise matrix R were determined according to the nominal specifications of the RTK–IMU sensor and refined through empirical tuning. R was initialized based on the RTK–IMU accuracy (2–3 cm in position and about 0.2° in heading), while Q was selected to represent slip variation and model uncertainty, and was adjusted through repeated simulations and field tests to ensure stable EKF convergence.
3.2.2 Improved particle swarm optimization algorithm based on the chebyshev window
To enhance the adaptive adjustment performance of the slip compensation angle δ in Pure Pursuit control, this study employs a particle swarm optimization (PSO) algorithm to rapidly compute the target offset angle δ within each control cycle. The PSO method offers advantages such as simple structure, strong global search capability, and fast convergence, making it well suited for single-variable real-time optimization problems in trajectory tracking tasks (Sun et al., 2022).
It is also worth noting that PSO-based parameter optimization has been widely adopted in mobile and tracked robot control using simplified kinematic models. Yang et al. applied an improved PSO algorithm to optimize the controller of a crawler robot while relying on a non-dynamic model, and achieved high tracking accuracy in unstructured environments (Yang et al., 2025). This further supports the adequacy of using a kinematic model for optimization in low-speed tracked platforms.
PSO simulates the cooperative search behavior of a particle swarm (such as a flock of birds or a school of fish) in the solution space. Suppose the swarm contains N particles, and the position and velocity of each particle are represented as shown in Equation 26:
The update equations for the i-th particle at iteration t are given by Equation 27:
where pi"is the personal best position of the i-th particle, g is the global best position of the swarm, c1"and c2"are the cognitive and social learning factors, respectively, r1,r2~U(0,1) are uniformly distributed random numbers, and ω is the inertia weight used to balance global exploration and local convergence.
To compensate for the heading deviation caused by asymmetric slip between the left and right tracks, a slip compensation angle δ is introduced to adjust the direction of the target point. The controller adopts a “slip-aware look-ahead point offset” strategy, meaning that an optimal offset angle is selected in each control cycle to minimize the deviation between the actual vehicle trajectory and the ideal trajectory over a future prediction horizon.
Let the current state be (x, y, θ), the slip ratios estimated by the EKF be sL"and sR, and the reference path be denoted as Path. The multi-step prediction cost function is constructed as shown in Equation 28:
where represents the actual vehicle position at step k considering slip and the offset angle δ, and denotes the ideal position under the no-slip and no-offset condition. Nstep is the prediction horizon, and ωpos and ωyaw"are the weights for the position and heading errors, respectively. In this study, ωpos = 1.0 and ωyaw = 0.2.
The weights ωpos = 1.0 and ωyaw = 0.2 were chosen according to the relative impact of lateral and heading errors on the offset angle δ. A higher ωpos ensures effective correction of lateral deviation, while a smaller ωyaw avoids excessive steering adjustments. Preliminary tuning showed that this ratio achieves stable and smooth compensation, and δ remains insensitive within a reasonable range of weight variations.
The optimization objective is to minimize this cost function using the particle swarm optimization algorithm, as expressed in Equation 29:
The optimization process of the particle swarm algorithm is as follows:
1. Population initialization: Randomly initialize particle positions and velocities within the interval .
2. Fitness evaluation: Each particle corresponds to a candidate offset angleδ; the multi-step prediction function is executed to compute the objective function J(δ).
3. Position update: Particle positions are iteratively updated according to the update equations.
4. Termination: The algorithm terminates when the maximum number of iterations is reached or when the cost function converges, and the optimal δ* is output.
The inertia weight ω controls the degree to which the current velocity of a particle is preserved and is a key factor influencing PSO convergence performance. A larger ω favors global exploration, whereas a smallerωstrengthens local search capability. Traditional approaches commonly adopt a linear decreasing inertia weight strategy, as given in Equation 30:
However, this setting provides limited exploration capability in the early iterations of the particle swarm, making it prone to local optima. Moreover, the linear decay of the inertia weight causes a slow reduction in the later stages, which may result in excessively large particle velocities near convergence, leading to oscillation and unstable convergence behavior (/Arasomwan et al., 2013). To enhance early-stage exploration and late-stage convergence, this study introduces a nonlinear decay strategy with a Chebyshev-like window shape (Guo and Wu, 2018), as expressed in Equation 31:
where t denotes the current iteration number and T is the maximum number of iterations. ωmax"and ωmin represent the initial and final inertia weights, respectively. The parameter K>0 controls the nonlinearity of the decay curve; K=1 corresponds to the standard cosine attenuation, while K<1 produces a smoother curve that emphasizes exploration. Based on multiple trials in this study, setting K=0.8 allows the algorithm to maintain strong global search capability in the early stage while ensuring rapid convergence in the later stage, thereby improving optimization accuracy.
As shown in Figure 7, the curves of the inertia weight under linear decay and the proposed Chebyshev-like nonlinear decay are compared. It can be observed that the improved inertia-weight curve preserves the “memory” of the particle swarm during the early iterations, enabling broader exploration of the global solution space, while the rapid decay in the later stage enhances local search capability and solution refinement.
Multiple comparative simulation experiments were conducted in the MATLAB R2022b environment using the two inertia-weight strategies. The swarm size was set to 30, the maximum number of iterations to 100, and the control-cycle compensation interval to 0.1 s, with the optimization of δ performed once per cycle.
The results are summarized in Table 2. The experimental results show that the nonlinear decay strategy with a Chebyshev-like window significantly reduces the average computation time compared with the linear decay strategy, while also providing slightly improved solution accuracy. The average lateral error is reduced by 5.8%.
3.3 Filtering of velocity command signals
To suppress sensor noise and high-frequency oscillations generated within the controller, a first-order low-pass filter is introduced to smooth the commanded velocities of the left and right tracks (Pagkalos et al., 2023). Its discrete-time formulation is expressed as shown in Equation 32:
where and are the calculated left and right track velocities at time step k; and are the filtered velocities used as the actual motor command inputs; and is the filtering coefficient, where a larger value results in smoother filtering with slower response, while a smaller value yields a more responsive output.
In this study, β = 0.6 is empirically selected, which effectively suppresses fluctuations in the commanded velocities without causing significant response delay, thereby improving the stability of track actuation and the accuracy of path tracking.
4 Simulation and experimental results analysis
4.1 Simulation validation
To verify the effectiveness of the proposed slip-aware look-ahead point offset path tracking method, simulation experiments were first conducted using MATLAB R2022b. The simulation model was constructed based on the differential-drive kinematic equations of the tracked agricultural vehicle, with slip disturbances introduced to emulate non-ideal operating conditions in complex farmland terrain. The main simulation parameters are set as follows: track width of 0.5 m, operating speed of 0.75 m/s, and sampling period of 0.1 s. The reference path, as shown in Figure 8a, has a total length of approximately 40 m and exhibits an “S-shaped” profile. The corresponding curvature distribution in Figure 8b demonstrates its ability to represent complex terrain trajectories encountered in farmland operations. To simulate the challenging conditions of soft farmland soil, segmentally varying slip ratios were introduced, as illustrated in Figure 8c. The slip ratios of both tracks exhibit a step-wise increasing pattern, with the left track exhibiting a generally higher slip level than the right track. The combined slip ratio eventually reaches approximately 0.4, providing the necessary basis for validating the slip compensation capability of the proposed control strategy.
Figure 8. Schematic of path and slip condition settings. (a) Reference path diagram, (b) Path curvature variation curve, (c) Left and right track slip ratio variation diagram.
Two control methods were compared in the simulation experiments:(1) the traditional fuzzy Pure Pursuit control; and (2) the proposed improved method integrating EKF-based slip estimation and Chebyshev-window-enhanced PSO compensation.
It should be emphasized that the objective of this work is not to redesign a completely new dynamic controller, but to enhance the slip robustness of geometric path-tracking schemes that are widely deployed on low-speed tracked agricultural platforms. Therefore, a fuzzy Pure Pursuit controller is selected as a representative baseline method due to its simple structure, low implementation cost, and strong real-time performance. The proposed slip-aware offset compensation is integrated on top of this baseline to improve tracking accuracy under slip disturbances.
The trajectory comparison results for the “S-shaped” path are shown in Figure 9. Under the traditional fuzzy Pure Pursuit control, significant trajectory deviation occurs when slip is present, with an average lateral error of 0.26 m. The lateral deviation further increases in regions with large curvature variations, reaching a maximum deviation of 0.41 m.In contrast, the proposed method compensates for the slip-induced heading deviation by adjusting the target-point offset angle in real time according to the estimated slip ratios. The real-time evolution of the offset angle is shown in Figure 10. After applying the slip-aware offset compensation, the actual trajectory closely follows the ideal path, with an average lateral error of 0.05 m and a maximum lateral error of 0.12 m.
The simulation results demonstrate that the proposed path tracking algorithm maintains high tracking accuracy even under significant slip conditions.
4.2 Field experiment
To further validate the effectiveness of the proposed path tracking algorithm, a field experiment platform based on a tracked chassis was constructed. The physical structure and system architecture of the platform are shown in Figure 11. The experimental platform mainly consists of a main control system, a drive system, a positioning module, and an operation module.
Figure 11. Path-tracking experimental platform of tracked agricultural vehicle and composition of the control system. (a) Tracked agricultural vehicle (real machine), (b) Control system composition diagram.
The test vehicle adopts a tracked differential-drive configuration. A chemical tank is mounted at the front of the chassis, while the rear is equipped with a diesel-powered air-assisted sprayer, enabling pesticide spraying functions required for plant protection operations. The left and right tracks are independently driven by brushless DC motors coupled with reduction gearboxes, enabling differential steering and straight-line motion. Before each experiment, the RTK–IMU module was initialized using the default zero-bias settings, followed by a short static alignment procedure to ensure coordinate consistency between the RTK and IMU outputs.
The main parameters of the vehicle are listed in Table 3.
The field experiments were conducted in the test farmland at the Pidu Campus of Xihua University, as shown in Figure 12. The ground surface was in a cultivated state with soft soil conditions, representing a typical high-slip terrain. The experimental trajectory was designed as a loop-shaped path consisting of straight segments and turning segments, with turning radii ranging from 2.5 m to 5 m. This layout effectively evaluates the adaptability, robustness, and slip-awareness capability of the proposed path tracking algorithm under complex terrain conditions.
The vehicle was tested under two control modes: “fuzzy Pure Pursuit” and the proposed “slip-aware look-ahead point offset” strategy. The test speeds were set to 0.35 m/s and 0.75 m/s. For each mode and speed, the vehicle trajectory and tracking deviations were recorded. The tracking performance results are shown in Figure 13 and Figure 14.
Figure 13. Path-tracking comparison at different speeds. (a) Set vehicle speed v=0.35m/s, (b) Set vehicle speed v=0.75m/s.
To ensure data reliability, each experiment was repeated three times. The statistical results of the repeated trials are summarized in Table 4, where the plotted results correspond to the A1 and B1 test groups.
From the results shown in the figures, the traditional fuzzy Pure Pursuit method exhibits varying degrees of deviation in both straight and turning segments, with larger deviations occurring at higher vehicle speeds. The deviation becomes particularly pronounced in the turning regions at both ends of the path, where differential slip between the tracks leads to significant trajectory drift.
In addition to the trajectory comparison, the internal responses of the proposed control framework were examined to verify the effectiveness of each module. The EKF-estimated slip ratios exhibit clear consistency with the expected soil-condition settings and operational behaviors. Specifically, the left track shows a higher estimated slip level during left-turn segments, while the right track presents a larger slip ratio in right-turn segments, matching the physical characteristics of differential-steering tracked vehicles. Although the true slip ground-truth is not directly measurable in field conditions, the estimated slip presents smooth temporal evolution without abrupt jumps, indicating stable EKF convergence.
The velocity commands generated by the controller are also smooth due to the low-pass filtering, and no oscillation or overshoot is observed throughout the experiments. During curved segments, the inner track velocity decreases while the outer track velocity increases, which aligns with the vehicle’s turning geometry. These observations confirm that the slip-aware offset mechanism and the adaptive tuning modules operate correctly and contribute jointly to the improved tracking performance.
In contrast, after applying the slip-aware offset compensation strategy, the vehicle trajectory aligns much more closely with the reference path. The straight-line segments display improved stability, and the turning deviations are effectively corrected. Overall, the proposed method demonstrates higher tracking accuracy and smoother trajectory performance.
According to Table 4, when the vehicle speed is 0.35 m/s, both the maximum and average lateral deviations are significantly reduced after applying the offset compensation strategy. The maximum lateral deviation is reduced by 78.1%, and the average lateral deviation decreases by 50.6%.
When the speed is increased to 0.75 m/s, the maximum lateral deviation is reduced by 63.1%, while the average lateral deviation decreases by 57.6%.
These results indicate that the proposed slip-aware offset compensation control method effectively suppresses lateral deviation at different operating speeds, ensuring stable and robust path tracking performance.
5 Conclusions and future work
1. To address the degradation of path tracking accuracy caused by slip in tracked agricultural machinery operating in complex farmland environments, this study proposes a slip-aware look-ahead point offset path tracking control method. Building upon the traditional Pure Pursuit algorithm, the method incorporates a fuzzy controller for adaptive optimization of the look-ahead distance, employs an extended Kalman filter to achieve online slip-ratio estimation, and integrates an improved particle swarm optimization algorithm to determine the optimal target-point offset angle. These enhancements significantly improve the adaptability and robustness of the controller under slip conditions.
2. Both simulation and field experiments demonstrate strong tracking performance of the proposed method. At operating speeds of 0.35 m/s and 0.75 m/s, the maximum lateral deviation is reduced by 78.1% and 63.1%, respectively, while the average lateral deviation is reduced by 50.6% and 57.6% compared with the fuzzy control baseline. These results verify the practicality and engineering feasibility of the proposed approach, showing its capability to meet operation requirements in complex farmland environments.
3. Future work will further incorporate vehicle dynamics and operation loads, and include more comprehensive benchmarking against classical dynamic controllers such as LQR and MPC by embedding the proposed slip-aware offset mechanism into these frameworks. In addition, lightweight optimization algorithms will be explored to enhance real-time performance, and multi-machine collaboration and intelligent scheduling platforms will be integrated to extend the applicability of the proposed method to large-scale intelligent agricultural machinery systems.
Data availability statement
The original contributions presented in the study are included in the article/supplementary material. Further inquiries can be directed to the corresponding author.
Author contributions
HL: Funding acquisition, Methodology, Supervision, Writing – review & editing. ZH: Conceptualization, Data curation, Methodology, Software, Writing – original draft. JY: Project administration, Validation, Writing – original draft. BJ: Data curation, Funding acquisition, Resources, Writing – review & editing. JM: Data curation, Methodology, Validation, Writing – original draft. HT: Conceptualization, Formal Analysis, Project administration, Writing – original draft. XL: Data curation, Methodology, Supervision, Writing – original draft.
Funding
The author(s) declared that financial support was received for this work and/or its publication. This work was supported by the National Natural Science Foundation of China (Grant No. 32501805), the Sichuan Provincial Natural Science Foundation (Grant No. 2025ZNSFSC1004), the Sichuan Provincial Science and Technology Program (Grant No. 2025NZZJ0009), and the Engineering Innovation Projects (Grant Nos. YK20240116 and YK20240117).
Acknowledgments
The authors would like to express their sincere gratitude to the Modern Agricultural Equipment Research Institute of Xihua University for providing experimental facilities and technical support. The authors also acknowledge the assistance of the research team members during the field experiments and data collection. Their contributions and cooperation greatly improved the quality of this work.
Conflict of interest
The authors declared that this work was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.
Generative AI statement
The author(s) declared that generative AI was not used in the creation of this manuscript.
Any alternative text (alt text) provided alongside figures in this article has been generated by Frontiers with the support of artificial intelligence and reasonable efforts have been made to ensure accuracy, including review by the authors wherever possible. If you identify any issues, please contact us.
Publisher’s note
All claims expressed in this article are solely those of the authors and do not necessarily represent those of their affiliated organizations, or those of the publisher, the editors and the reviewers. Any product that may be evaluated in this article, or claim that may be made by its manufacturer, is not guaranteed or endorsed by the publisher.
Abbreviations
RTK, Real-Time Kinematic; IMU, Inertial Measurement Unit; GNSS, Global Navigation Satellite System; EKF, Extended Kalman Filter; PSO, Particle Swarm Optimization; MPC, Model Predictive Control; RPM, Revolutions Per Minute; RMSE, Root Mean Square Error; Ld, Adaptive Look-Ahead Distance; δ, Target-Point Offset Angle; β, Low-Pass Filter Coefficient; θ, Vehicle heading angle; sL, sR, Left and right track slip ratios; nL, nR, Left and right motor rotational speeds.
References
Arasomwan, M. A. and Adewumi, A. O. (2013). A novel adaptive fuzzy sliding mode controller for mobile robots path tracking. Sci. World J. 2013, 860289. doi: 10.1155/2013/860289
Bai, G., Liu, L., Meng, Y., Liu, S., Liu, L., Luo, W., et al. (2020). Real-time path tracking of mobile robots based on nonlinear model predictive control. Trans. Chin. Soc. Agric. Eng. 51, 47–52. doi: 10.6041/j.issn.1000-1298.2020.09.006
Chen, J. and Wang, Y. (2024). Review of path tracking control methods for unmanned tractors. J. Agric. Mechanization Res. 46, 1–7. doi: 10.13427/j.cnki.njyi.20240018.005
Chen, K., Xie, S., Chen, C., Xiang, W., and Liu, W. (2024). Research on differential navigation system of agricultural machinery in hilly areas based on dual preview pure tracking algorithm. J. Chin. Agric. Mechanization 45, 187–193. doi: 10.13733/j.jcam.issn.20955553.2024.02.027
Cui, B., Sun, Y., Ji, F., Wei, X., Zhu, Y., Zhang, S., et al. (2022). Path tracking algorithm of agricultural machinery for whole field based on fuzzy Stanley model. Trans. Chin. Soc. Agric. Eng. 53, 43–48. doi: 10.6041/j.issn.1000-1298.2022.12.004
Guo, N., Liu, J., Li, J., Chen, W., Zhang, Y., and Lu, Q. (2025). Handling-stability control for distributed drive electric vehicles via Lyapunov-based nonlinear MPC algorithm. IEEE Trans. Transportation Electrification 11, 6615–6628. doi: 10.1109/TTE.2024.3513438
Guo, T. and Wu, M. (2018). A wideband digital array beamforming method of conformal array antenna based on digital filters. Hans J. Wireless Commun. 8, 80–85. doi: 10.12677/hjwc.2018.82009
He, J., Hu, L., Wang, P., Liu, Y., Man, Z., Tu, T., et al. (2022). Path tracking control method and performance test based on agricultural machinery pose correction. Comput. Electron. Agric. 200, 107185. doi: 10.1016/j.compag.2022.107185
Hu, C., Ru, Y., Li, X., Fang, S., Zhou, H., Yan, X., et al. (2024). Path tracking control for brake-steering tracked vehicles based on an improved pure pursuit algorithm. Biosyst. Eng. 242, 1–15. doi: 10.1016/j.biosystemseng.2024.04.006
Jiao, J., Chen, J., Qiao, Y., Wang, W., Wang, M., Gu, L., et al. (2018). Adaptive sliding mode control of trajectory tracking based on DC motor drive for agricultural tracked robot. Trans. Chin. Soc. Agric. Eng. 34, 64–70. doi: 10.11975/j.issn.1002-6819.2018.04.008
Jiao, J., Kong, W., Wang, Q., Chen, L., Gu, L., Gao, Y., et al. (2015). Adaptive sliding mode control of agricultural tracked robot based on input fuzzification. Trans. Chin. Soc. Agric. Machinery 46, 14–19. doi: 10.6041/j.issn.1000-1298.2015.06.003
Li, T., Hu, J., Gao, L., Liu, X., and Zhang, W. (2013). Agricultural machine path tracking method based on fuzzy adaptive pure pursuit model. Trans. Chin. Soc. Agric. Machinery 44, 205–210. doi: 10.6041/j.issn.1000-1298.2013.01.03
Li, J., Wang, S., Zhang, W., Li, H., Zeng, Y., Wang, T., et al. (2023). Research on path tracking for an orchard mowing robot based on cascaded model predictive control and anti-slip drive control. Agronomy 13, 1395. doi: 10.3390/agronomy13051395
Liu, W., Guo, R., and Zhao, J. (2023). Predictive path tracking control method for agricultural machinery based on preview model. Trans. Chin. Soc. Agric. Eng. 39, 39–50. doi: 10.11975/j.issn.1002-6819.202303109
Liu, H., Han, Z., Bao, J., Luo, J., Yu, H., Wang, S., et al. (2025a). Intelligent path tracking for single-track agricultural machinery based on variable universe fuzzy control and PSO-SVR steering compensation. Agriculture 15, 1136. doi: 10.3390/agriculture15111136
Liu, H., Tang, J., Zou, S., Zhang, L., Yu, H., Wang, S., et al. (2025b). Strategy-based adaptive path tracking control method for agricultural machinery based on multi-objective optimization. Trans. Chin. Soc. Agric. Eng. 56, 198–207. doi: 10.6041/j.issn.1000-1298.2025.03.020
Pagkalos, K., Panetas-Felouris, O., and Vlassis, S. (2023). A time-mode PWM 1st order low-pass filter. J. Low Power Electron. Appl. 13, 32. doi: 10.3390/jlpea13020032
Qian, J., Feng, S., Li, H., and Zhang, Y. (2024). Research on path tracking control algorithm of agricultural machinery based on extended Kalman filter. J. Chin. Agric. Mechanization 45, 215–221. doi: 10.13733/j.jcam.issn.20955553.2024.07.032
Shi, Y., Cheng, X., Xi, X., Shan, X., Jin, Y., Zhang, R., et al. (2023). Research progress on path tracking control methods for agricultural machinery navigation. Trans. Chin. Soc. Agric. Eng. 39, 1–14. doi: 10.11975/j.issn.1002-6819.202304004
Song, Y., Xue, J., Zhang, T., Sun, X., Sun, H., Gao, W., et al. (2025). Path tracking control of crawler tractor based on adaptive adjustment of lookahead distance using sparrow search algorithm. Comput. Electron. Agric. 234, 110219. doi: 10.1016/j.compag.2025.110219
Sun, Y., Cui, B., Ji, F., Wei, X., and Zhu, Y. (2022). The full-field path tracking of agricultural machinery based on PSO-enhanced fuzzy Stanley model. Appl. Sci. 12, 7683. doi: 10.3390/app12157683
Sun, J., Zeng, L., Ying, J., Zheng, H., Sun, Q., Meng, X., et al. (2024). Research status and prospects of key technologies of agricultural tracked chassis. Trans. Chin. Soc. Agric. Eng. 55, 202–219. doi: 10.6041/j.issn.1000-1298.2024.11.022
Wang, H., Wang, G., Luo, X., Zhang, Z., Gao, Y., He, J., et al. (2019). Path tracking control method of agricultural machine navigation based on aiming pursuit model. Trans. Chin. Soc. Agric. Eng. 35, 11–19. doi: 10.11975/j.issn.1002-6819.2019.04.002
Wang, C. and Xiong, H. (2025). “High-dynamic trajectory tracking control for four-wheel steering vehicles based on coupled MPC,” in Proceedings of the 2025 5th International Conference on Computer, Control and Robotics (ICCCR), 231–235. doi: 10.1109/ICCCR65461.2025.11072659
Wang, L., Zhai, Z., Zhu, Z., and Mao, E. (2022). Path tracking control of an autonomous tractor using improved Stanley controller optimized with multiple-population genetic algorithm. Actuators 11, 22. doi: 10.3390/act11010022
Xu, L., Chen, R., and Yuan, H. (2023). Path tracking control method for wheeled tractors with slope disturbance. Trans. Chin. Soc. Agric. Machinery 54, 421–430. doi: 10.6041/j.issn.1000-1298.2023.11.040
Yang, Z., Lang, Q., Xiong, Y., Yang, S., Zhang, C., Deng, L., et al. (2025). Research on trajectory tracking control method for crawler robot based on improved PSO sliding mode disturbance rejection control. Sensors. 25, 2113. doi: 10.3390/s25072113
Yang, C., Zheng, D., Chen, S., Mansurova, M., Belgibaev, B., and Zhao, B. (2025). AgriPath: a robust multi-objective path planning framework for agricultural robots in dynamic field environments. Front. Plant Science. 16. doi: 10.3389/fpls.2025.1687747
Zhang, C., Dong, W., Xiong, Z., Hu, Z., Wang, D., Ding, Y., et al. (2021). Design and experiment of fuzzy adaptive pure pursuit control of crawler-type rape seeder. Trans. Chin. Soc. Agric. Machinery 52, 105–114. doi: 10.6041/j.issn.1000-1298.2021.12.011
Zhang, W., Hu, L., Wang, H., Zhang, G., Luo, X., Zhang, Z., et al. (2024). Improved pure pursuit agricultural machinery navigation curve path tracking method based on B-spline optimization. Trans. Chin. Soc. Agric. Machinery 55, 42–51. doi: 10.6041/j.issn.1000-1298.2024.09.003
Zhang, M., Ji, Y., Li, S., Cao, R., Xu, H., Zhang, Z., et al. (2020). Research progress of agricultural machinery navigation technology. Trans. Chin. Soc. Agric. Machinery 51, 1–18. doi: 10.6041/j.issn.1000-1298.2020.04.001
Zhao, R., Ding, S., He, J., Man, Z., He, Z., Ruan, Q., et al. (2025). Path tracking error compensation improved MPC control method for crawler weeding machine. Trans. Chin. Soc. Agric. Machinery 56, 326–334. doi: 10.6041/j.issn.1000-1298.2025.09.024
Keywords: extended Kalman filter, improved particle swarm optimization, pure pursuit algorithm, slip compensation, tracked agricultural machinery
Citation: Liu H, Han Z, Yin J, Bao J, Mu J, Tan H and Liu X (2026) Path tracking control method for tracked agricultural vehicles based on slip-aware look-ahead point offset. Front. Plant Sci. 16:1754679. doi: 10.3389/fpls.2025.1754679
Received: 26 November 2025; Accepted: 09 December 2025; Revised: 06 December 2025;
Published: 05 January 2026.
Edited by:
Changkai Wen, China Agricultural University, ChinaReviewed by:
Ningyuan Guo, Foshan University School of Mechatronic Engineering and Automation, ChinaChen Ding, Fuyang Normal University, China
Copyright © 2026 Liu, Han, Yin, Bao, Mu, Tan and Liu. This is an open-access article distributed under the terms of the Creative Commons Attribution License (CC BY). The use, distribution or reproduction in other forums is permitted, provided the original author(s) and the copyright owner(s) are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.
*Correspondence: Huanyu Liu, bGl1aHkwNTI4QDE2My5jb20=
Zhihang Han1