Skip to main content
Advertisement
Browse Subject Areas
?

Click through the PLOS taxonomy to find articles in your field.

For more information about PLOS Subject Areas, click here.

  • Loading metrics

Research on trajectory tracking control of tracked vehicles based on hydraulic motor system identification and Laguerre-MPC

  • Sheng Jin ,

    Roles Conceptualization, Data curation, Formal analysis, Writing – original draft, Writing – review & editing

    jinsheng@stu.hunau.edu.cn

    Affiliations College of Mechanical and Electrical Engineering, Hunan Agricultural University, Changsha, Hunan, China, Sunward Intelligent Equipment Co., Ltd., Changsha, Hunan, China

  • Daqing Zhang ,

    Roles Funding acquisition, Investigation, Methodology, Writing – review & editing

    jinsheng@stu.hunau.edu.cn

    Affiliations College of Mechanical and Electrical Engineering, Hunan Agricultural University, Changsha, Hunan, China, Sunward Intelligent Equipment Co., Ltd., Changsha, Hunan, China

  • Qijun Tang,

    Roles Supervision, Validation

    Affiliations College of Mechanical and Electrical Engineering, Hunan Agricultural University, Changsha, Hunan, China, Sunward Intelligent Equipment Co., Ltd., Changsha, Hunan, China

  • Haoyu Huang,

    Roles Project administration, Resources

    Affiliation College of Mechanical and Electrical Engineering, Hunan Agricultural University, Changsha, Hunan, China

  • Hongjie Luo,

    Roles Resources, Software

    Affiliation College of Mechanical and Electrical Engineering, Hunan Agricultural University, Changsha, Hunan, China

  • Yuming Zhao,

    Roles Writing – review & editing

    Affiliation Sunward Intelligent Equipment Co., Ltd., Changsha, Hunan, China

  • Kang Wu

    Roles Writing – review & editing

    Affiliation Sunward Intelligent Equipment Co., Ltd., Changsha, Hunan, China

Abstract

To address the high computational cost of model predictive control and the high complexity associated with physics-based modeling of hydraulic drive systems in trajectory tracking of tracked unmanned vehicles, a hierarchical control framework is proposed to enhance trajectory tracking performance. In the upper-layer control, a Laguerre function-based model predictive control (Laguerre-MPC) strategy is developed to reduce the computational burden while maintaining control performance. In the lower-layer control, Hammerstein-Wiener identification is employed to establish control models for the left and right hydraulic motors, thereby avoiding the modeling complexity inherent to hydraulic systems. Moreover, a proportional-integral-derivative (PID) controller is incorporated into the lower-layer control to improve disturbance rejection during operation. Simulation results indicate that Laguerre-MPC yields substantially lower computational complexity than conventional MPC, with the average time required for a single optimization being only 24.3% of that required by conventional MPC, which improves the real-time capability of the control algorithm. Furthermore, field experiments are conducted on a tracked unmanned vehicle equipped with relevant sensors, including speed tracking and trajectory tracking tests under specified operating conditions. The results confirm the effectiveness of the proposed framework: compared with the conventional MPC + PID scheme, the proposed method achieves higher tracking accuracy, improving the average speed tracking accuracy by 28.7%, the straight-line trajectory tracking accuracy (root mean square error) by 65.5%, and the curved trajectory tracking accuracy (root mean square error) by 10.1%. The proposed framework provides a practical and efficient solution for trajectory tracking control of tracked unmanned vehicles with clear engineering applicability.

Introduction

Tracked vehicles are widely deployed in unstructured environments, including disaster rescue and agricultural operations, because of high mobility and strong impact resistance. These platforms perform mission-critical tasks such as emergency response and material transport [1,2]. Precise trajectory tracking, however, is difficult to achieve because hydraulic systems exhibit pronounced nonlinearity and time delay [3]. Track slippage on unstructured terrains can further degrade tracking accuracy, but this factor is outside the scope of the present study. Therefore, enhancing trajectory tracking accuracy for hydraulically driven tracked unmanned platforms is a key enabling technology for intelligent operation [4].

Trajectory tracking and control for autonomous vehicles have been widely investigated in both domestic and international studies. Representative approaches include PID control [5], preview control [6], linear quadratic regulator [7], sliding mode control [8], fuzzy control [9], and adaptive control [10]. However, when applied to nonlinear systems, many of these methods show reduced effectiveness and provide limited capability for addressing constraint-related problems.

In contrast, model predictive control (MPC) provides clear advantages for tracked unmanned platforms by explicitly handling constraints and enabling optimal control, and it has been widely used in autonomous trajectory tracking [11,12]. Li et al [13] integrated the particle swarm optimization algorithm into MPC to optimize the weight matrices online, thereby improving trajectory tracking accuracy and dynamic response.Wang et al [14] adjusted MPC weights using a fuzzy adaptive weight control algorithm, which improved vehicle path tracking accuracy. You et al [15] combined MPC with an adaptive neuro-fuzzy inference system to develop a control strategy for ground mobile robots, and validated its effectiveness through real-vehicle experiments. Guo et al [16] proposed an LNMPC + improved iLQR strategy that generates a unified yaw rate reference based on front-wheel steering angle feedback, thereby enhancing handling stability, robustness, and real-time performance for distributed drive electric vehicles. Botes et al [17] incorporated road friction into a nonlinear predictive model to estimate dynamic constraints, including slip angles, yaw rates, and rollover risks, thereby improving lateral stability. Nevertheless, most of these methods have been validated only in simulation, while practical effects induced by inherent dynamics, nonlinearities, and response delays in hydraulic and transmission systems are often not fully considered. In addition, overly long control horizons impose a substantial computational burden.

In hydraulic system control, sliding mode control [18] and active disturbance rejection control [19] can reduce reliance on accurate models during operation. Nevertheless, hydraulic mechanisms exhibit inherent nonlinearity, friction, and leakage, which increase model uncertainty and degrade model fidelity. Consequently, system identification-based approaches have attracted growing attention in recent years. These approaches construct mathematical models from input-output data, thereby alleviating the adverse effects associated with model uncertainty [20].

Hulttinen et al [21] investigated a hydraulic manipulator and identified key parameters, including friction and flow coefficients, using parameter identification methods. Subsequent motion tests showed a substantial improvement in tracking performance. Chen et al [22] integrated theoretical modeling with system identification to develop a hydrostatic drive model, which improved motion control of tracked vehicles. Zhang et al [23] studied an electro-hydrostatic servo system and applied least squares and genetic algorithms to identify critical parameters, thereby increasing model accuracy. Xu et al [24] combined theoretical modeling and system identification to derive the transfer function of the control model for an asymmetric hydraulic cylinder servo pump system, providing practical guidance for hydraulic control applications. However, despite these approaches, obtaining a simplified hydraulic system model remains difficult, and parameter identification is often limited by high time consumption and high cost.

In summary, two key challenges remain in existing studies. First, traditional MPC involves substantial computational complexity, which makes real-time implementation difficult to guarantee. Second, hydraulic drive systems are strongly nonlinear and difficult to model accurately, and modeling accuracy is often achieved at the expense of increased complexity. As a result, trajectory tracking for tracked vehicles rarely satisfies real-time and high-precision requirements simultaneously. To overcome these limitations, a hierarchical control framework is proposed. In the upper layer, Laguerre functions are introduced to reduce the decision-variable dimension of conventional MPC, thereby markedly decreasing the online computational burden. In the lower layer, a hydraulic motor model is identified using the Hammerstein-Wiener method, and a PID controller is incorporated for speed correction and disturbance compensation. The resulting architecture improves the real-time feasibility of MPC while enhancing actuator dynamic response, enabling coordinated improvements in tracking accuracy and computational complexity. Moreover, the proposed framework is transferable to real-time optimal control problems in complex systems, such as chemical processes, power systems, aerospace, metallurgical equipment, marine engineering, and new energy applications. The main contributions are summarized as follows:

  1. (1) An upper-layer Laguerre-based model predictive control (Laguerre-MPC) strategy is developed. By employing Laguerre orthogonal basis functions for dimensionality-reduced optimization of MPC control variables, the computational load is significantly reduced without sacrificing control precision, thereby supporting real-time trajectory tracking. This layer provides accurate control commands to the lower-layer hydraulic actuators and establishes the basis for high-precision tracking performance.
  2. (2) In the lower layer, a nonlinear mapping between hydraulic motor input (control current) and output (rotational speed) is established via data acquisition, which avoids the cumbersome physical modeling procedure. A proportional-integral-derivative (PID) controller is integrated to perform real-time speed regulation and disturbance compensation. Owing to its fast response and straightforward tuning, the PID controller dynamically corrects the speed commands in real time, compensating for the limited anti-interference capability of a stand-alone identification model and ensuring accurate tracking of the upper-layer Laguerre-MPC commands.
  3. (3) Comprehensive experiments, including speed tracking, straight-line trajectory tracking, and curved trajectory tracking, are conducted on a hydraulically driven tracked unmanned vehicle. The results demonstrate the effectiveness and superiority of the proposed control strategy.

The remainder of this paper is organized as follows. The Tracked Vehicle Model section presents a hydraulically driven tracked unmanned vehicle model, including the tracked-vehicle kinematic model and an identification method for the hydrostatic drive system model. Next, the Controller Design section details the hierarchical control strategy and its implementation. The Experiment section then reports trajectory-tracking tests conducted on the fully hydraulic tracked unmanned vehicle, with results for speed tracking, straight-line trajectory tracking, and curved trajectory tracking. Finally, the Conclusions and Discussion section summarizes the main findings and outlines directions for future work.

Tracked vehicle model

Kinematic model of tracked vehicle

Initially, a global coordinate system XOY and a local coordinate system are defined. The local coordinate system is centered at the centroid M of the unmanned vehicle. Here, and denote the velocities of the right and left tracks, respectively. L represents the distance between the track centers, d indicates the track width, and signifies the orientation angle. A schematic diagram of the kinematic model is illustrated in Fig 1, and the corresponding kinematic equations [25] are presented in Eq (1):

(1)

where:

thumbnail
Fig 1. Schematic diagram of tracked vehicle motion.

https://doi.org/10.1371/journal.pone.0346824.g001

By performing a Taylor expansion of Eq (1) around the reference trajectory pose and reference velocity , the following is obtained:

(2)

where:

Discretizing Eq (2) yields:

(3)

where: , , .

Applying the difference operation to Eq (3), defining , and setting , the state-space equation is derived as shown in Eq (4).

(4)

where: , ,

With the control horizon defined as and the prediction horizon as , the state prediction equation at any time instant is expressed as:

(5)

where:

System identification of the hydrostatic drive system

A system identification model is developed using the solenoid valve input current and the hydraulic motor output rotational speed [22]. In the identification experiment, a stepwise current excitation signal is applied, and its amplitude is strictly limited to the non-saturated operating range of the pump-motor. With a constant step size of 0.018 A, the current increases linearly from 0.237 A to 0.567 A. This interval matches the effective adjustment range (225 mA–600 mA) of the solenoid valve for the travel motor in the tracked hydrostatic system, thereby covering the key nonlinear region from zero current to the start threshold current while maintaining bench-test operability and safety. Two sets of input-output data were obtained from bench tests, as shown in Fig 2; one set is used for system identification, and the other is used for model simulation validation. The controller sampling period is set to 0.05 s.

thumbnail
Fig 2. Identification test results:

(A) System identification input data; (B) System identification verification input data; (C) System identification output data; (D) System identification output data.

https://doi.org/10.1371/journal.pone.0346824.g002

Given the inherent differences between the left and right hydraulic drive systems, separate identification and simulation validation were conducted for each side. As illustrated in the experimental results in Fig 2 and the current–speed relationship validation for the left and right motors in Fig 3, the Hammerstein-Wiener model exhibited remarkable tracking performance, achieving a fitting accuracy of 90% for both motor models. The Hammerstein-Wiener model comprises three core components: an input nonlinear block, v(t) = f(u(t)); a linear dynamic system, w(t) = G(q)v(t); and an output nonlinear block, y(t) = h(w(t)).

thumbnail
Fig 3. System identification results and simulation verification:

(A) Left motor identification result; (B) Left motor verification result; (C) Right motor identification result; (D) Right motor verification result.

https://doi.org/10.1371/journal.pone.0346824.g003

Controller design

Overall framework

The overall architecture of the vehicle controller is illustrated in Fig 4. In the upper layer, Laguerre-MPC functions as the position-loop controller to track the desired trajectory . Laguerre-MPC outputs the commanded linear velocity and angular velocity of the unmanned vehicle. These commands are mapped by a velocity decoupling module into the rotational speeds of the left and right motors , which are used as reference inputs for the motor controllers. Using motor speed error signals, the motor speed controllers regulate pump displacement by modulating the input current, thereby driving the actual motor speeds to the commanded values and achieving the control objective. In addition, fused RTK-GPS and track-speed odometer measurements provide feedback of the robot’s pose and angular velocities , which are delivered to the controller for closed-loop operation.

thumbnail
Fig 4. Overall structure of the tracked unmanned vehicle controller.

https://doi.org/10.1371/journal.pone.0346824.g004

Within the velocity decoupling module, the vehicle’s linear velocity and angular velocities are transformed into the rotational speeds of the left and right motors as follows:

(6)

where represents the linear velocity of the vehicle, represents the angular velocity of the vehicle, and , indicate the rotational speeds of the left and right hydraulic motors, respectively.

Design of the MPC control algorithm based on laguerre functions

This section presents an MPC formulation based on Laguerre functions, and the corresponding control algorithm is illustrated in Fig 5. The algorithm design incorporates the kinematic model and system constraints, while Laguerre functions are embedded in the optimization procedure. To reduce the computational burden, the control sequence is approximated using Laguerre functions; this approach retains the control benefits associated with a long prediction horizon and maintains manageable computational complexity [26]. The Laguerre functions are defined as follows [27].

(7)(8)(9)
thumbnail
Fig 5. Structure diagram of Laguerre-MPC control.

https://doi.org/10.1371/journal.pone.0346824.g005

Where, a represents the pole, with a value constrained to the range ; N denotes the order of the Laguerre function. After performing the inverse z-transform on each term in Eqs (7) to (9), the discrete-time Laguerre function can be expressed in vector form as:

(10)

where corresponds to the Z-transform of , denoted as . Eq (10) can be reformulated as:

(11)

where: , and

Assuming the impulse response of a stable system at time k is H(k), and for a specified parameter N, the discrete-time impulse response of the dynamic system can be approximated using the Laguerre model as:

(12)

The time series of the control increment is approximated by a linear combination of Laguerre basis functions. Thus, at any instant ki, it can be expressed as:

(13)

where: .

By combining Eqs (4), (5) and (13), the state at time m relative to time can be derived as:

(14)(15)

The cost function and associated constraint in the MPC optimization problem are formulated as:

(16)(17a)(17b)(17c)

where: .

Leveraging the orthogonal properties of the Laguerre functions, the following relationship can be derived:

(18)

By integrating Eqs (14), (16), and (18), the cost function becomes:

(19)

As evident from Eq (19), the cost function depends on , while the third is independent of it. Consequently, the cost function can be rewritten as shown in Eq (20):

(20)

where:

By reformulating the constraints and substituting Eq (13) into (17), the updated constraints are obtained as:

(21)(22)(23)

Thus, the constraint on the control increment can be expressed as:

(24)

Similarly, the constraint on the control input can be reformulated as:

(25)

where:

Using Eq (3), the predicted value at time is derived as:

(26)

where:

Substituting Eqs (26) into (23) yields:

(27)

The constraint on the state variables can be rewritten as:

(28)

After consolidating, the optimization problem is expressed as:

(29)(30)

where:

Where being the variable to be optimized. represents a symmetric positive definite matrix, denotes the coefficient vector of the linear term, signifies the constraint matrix, and indicates the offset vector of the constraints.

For the constrained cost function described above, the optimal solution can be iteratively computed using the Lagrange multiplier method and Hildreth’s QP approach.

Stability analysis

Assumption:A terminal constraint is added to the receding horizon optimization as , where denotes the terminal state generated by the control sequence ().

For each sampling time k, there exists a parameter vector such that the cost function J attains its minimum value subject to inequality constraints and the terminal equality constraint .

Definition of Lyapunov Function:

(31)

At time k + 1, the Lyapunov function becomes:

(32)

The one-step state recursion is given by . By shifting the entire control sequence at time k, i.e., , forward by one step and appending a zero at the end of the sequence, a feasible control sequence at time k + 1 is obtained as:

(33)

Denote the cost corresponding to this feasible sequence as . Since the cost of the optimal solution is necessarily no greater than that of any feasible solution, we have:

(34)

Combining with the terminal constraint , the difference of the Lyapunov function is derived as follows:

(35)

It then follows that:

(36)

Since both Q and R are positive definite matrices, the right-hand side is negative semi-definite, and they are simultaneously zero if and only if x(k + 1) = 0 and . This indicates that the Lyapunov function is strictly decreasing with the sampling time. According to the Lyapunov asymptotic stability theorem, a Lyapunov function that satisfies the conditions of positive definiteness and strict decrease can guarantee the asymptotic stability of the closed-loop system.

Motor speed control module based on system identification

By utilizing the previously identified Hammerstein-Wiener model of the current–hydraulic motor speed relationship, we developed a motor speed controller as shown in Fig 6. Additionally, a PID controller is incorporated to mitigate the effects of external factors such as terrain variations. The motor speed controller uses the speed error signal and as its input and employs PID control to adjust the electromagnetic valve current, thereby regulating the pump displacement to ensure that the actual vehicle speed aligns with the target speed.

(37)

where e(t) represents the system error, is the proportional gain, is the integral gain, and is the derivative gain.

Experiment

Experiment platform and experiment condition

The effectiveness of the proposed method was assessed via trajectory tracking experiments conducted on a fully hydraulic tracked unmanned vehicle. The test platform had a mass of 8.8 tons and overall dimensions of 4.5 m × 2.2 m, and it was equipped with an industrial PC (AIMB-T1215DA-00Y0E), a Huace 410 integrated navigation system, a PLC, and auxiliary devices. The software stack ran on Ubuntu 18.04 under the ROS Kinetic framework, enabling low-latency real-time data processing and reliable control.

Experiments were performed on a sandy soil field measuring 200 m × 50 m. Two reference trajectories were specified: a straight line and a circular curve with a radius of 15 m. The onboard IPC synchronously recorded vehicle speed, left and right hydraulic motor speeds, and pose information (latitude, longitude, heading angle) with a sampling period of 0.05 s. The experimental program consisted of speed tracking tests and trajectory tracking tests. Owing to limitations in test conditions, the speed tracking test, straight-line trajectory tracking test, and curved trajectory tracking test were each conducted once.

For comparative evaluation, a conventional MPC + PID scheme was selected as the experimental baseline. This scheme represents a mature engineering solution for trajectory tracking control of hydrostatic drive tracked unmanned vehicles, in which PID is the mainstream approach for low-level actuation control. In simulation comparisons, only traditional MPC was considered to directly quantify the performance gain introduced by the proposed MPC algorithm, whereas the complete MPC + PID architecture was implemented in the experiments to align with practical engineering applications. The baselines and the proposed method share consistent control objectives and application scenarios, thereby supporting objective and credible performance verification.

Simulation experiments

Traditional MPC exhibits a fundamental trade-off in autonomous driving trajectory tracking. Improving tracking accuracy typically requires extending the prediction and control horizons (); however, longer horizons substantially increase the number of decision variables in the control sequence . As a result, the computational cost of quadratic programming (QP) solving grows rapidly, making it challenging to satisfy real-time requirements in autonomous driving. In contrast, reducing the horizon to enhance real-time performance weakens prediction capability and increases tracking error. To address this trade-off and evaluate the performance of Laguerre function-based MPC (Laguerre-MPC), simulation experiments are conducted in the MATLAB environment in this section, comparing the control performance of traditional MPC with the Laguerre-MPC developed in this paper.

Simulation studies were conducted in MATLAB to evaluate the performance of the Laguerre-based MPC strategy relative to a conventional MPC method. The trajectory tracking results in Fig 7A show higher tracking accuracy for Laguerre-MPC, as further evidenced by the magnified inset in the lower-right corner of Fig 7A. In contrast, the heading angle response in Fig 7B exhibits abrupt variations for Laguerre-MPC at the 7 m and 13 m positions. These discontinuities are attributed to rapid heading-error correction near trajectory inflection points, which induces sharp changes in control inputs and suggests increased sensitivity to trajectory deviations. Computational efficiency was further assessed using the MATLAB tic and toc functions. As reported in Table 1, Laguerre-MPC required 0.71 s, whereas conventional MPC required 2.94 s, corresponding to 24.3% of the conventional MPC runtime. This reduction highlights the computational advantage of the proposed strategy.

thumbnail
Fig 7. Laguerre-MPC and MPC simulation verification: (A) trajectory tracking; (B) vehicle heading angle.

https://doi.org/10.1371/journal.pone.0346824.g007

Velocity tracking experiments

Velocity tracking experiments were carried out to validate the effectiveness of a system identification-based motor speed control technique, with a conventional PID controller serving as a baseline for comparison. Target speeds were set at 1.5 km/h and 3 km/h, with a sampling interval of 0.05s. Controller parameters are summarized in Table 2.

thumbnail
Table 2. Controller parameters for velocity tracking.

https://doi.org/10.1371/journal.pone.0346824.t002

Results for the left and right hydraulic motors, depicted in Fig 8A and 8B, indicate that the developed technique yields lower tracking errors and better alignment with reference values compared to PID control. Furthermore, vehicle speed tracking data in Fig 8C and error profiles in Fig 8D reveal that while the PID controller exhibits notable overshoot, the proposed method stabilizes rapidly at the setpoint with minimal overshoot and a substantially shorter settling time.

thumbnail
Fig 8. Speed tracking test:

(A) Left motor speed; (B) Right motor speed; (C) Expected vehicle speed; (D) Expected vehicle speed error.

https://doi.org/10.1371/journal.pone.0346824.g008

Trajectory tracking experiments

Trajectory tracking tests were conducted to verify the performance of the proposed hierarchical control architecture, encompassing both straight-line and curved path scenarios. In the straight-line trajectory tracking test, two coordinate points were collected using RTK as the starting and ending points, with a distance of 100 meters between them. The line connecting these two points served as the reference trajectory for the straight-line tracking test. In the curve tracking test, six coordinate points were collected and connected to form an S-shaped curve, with adjacent points spaced 50 meters apart and a total length of 200 meters, which served as the reference trajectory for the curve tracking test. A comparative control scheme, combining MPC as the upper-layer controller and PID as the lower-layer controller (denoted as MPC + PID), was also evaluated. The reference velocity was set to 1.5 km/h, with a sampling period of 0.05s, and relevant controller parameters are listed in Table 3.

For straight-line trajectories, results in Fig 9A demonstrate that the developed strategy achieves exceptional convergence to the reference path, surpassing the MPC + PID approach in both accuracy and stability. Velocity profiles in Fig 9B further show reduced fluctuations in actual speed compared to the baseline method. Moreover, rotational speed responses of the left and right hydraulic motors, presented in Fig 9C and 9D, highlight improved dynamic stability under coordinated dual-motor control with the proposed framework.

thumbnail
Fig 9. Tracking results of the linear trajectory:

(A) Trajectory; (B) Vehicle speed; (C) Left-side velocity; (D) Right-side velocity.

https://doi.org/10.1371/journal.pone.0346824.g009

In curved trajectory tests, Fig 10A indicates that the proposed strategy maintains higher tracking accuracy, particularly in the initial phase, consistently outperforming MPC + PID despite a gradual decline in precision over time for both methods. Comparative analysis of vehicle speed and motor speeds in Fig 10B-10D reveals significant overshoot and variability in MPC + PID during turns, reflecting limited disturbance rejection. In contrast, the outputs of the proposed method are notably smoother, demonstrating stronger robustness under challenging conditions.

thumbnail
Fig 10. Tracking results of the curve trajectory:

(A) Trajectory; (B) Vehicle speed; (C) Left-side velocity; (D) Right-side velocity.

https://doi.org/10.1371/journal.pone.0346824.g010

The results of the tracking error for the two experiments are depicted in Fig 11, with the maximum error, root mean square error (RMSE), and mean error (ME) calculated and summarized in Table 4. Since GPS was utilized to supply positioning data during the entire experimental process, the unmanned vehicle demonstrated inaccurate parking positions at the starting points of both the straight-line and curved trajectory tracking tests. As a result, the error calculation began after 40 seconds. The results indicate that the tracking performance for both straight-line and curved trajectories is superior to that of the conventional MPC + PID trajectory tracking control.

thumbnail
Table 4. Tracking errors of the trajectory tracking experiment.

https://doi.org/10.1371/journal.pone.0346824.t004

thumbnail
Fig 11. Tracking errors for straight-line and curved trajectories:

(A) Tracking error of straight-line trajectory; (B) Tracking error of curved trajectory.

https://doi.org/10.1371/journal.pone.0346824.g011

Straight-Line trajectory scenario: Under the straight-line tracking condition, the proposed controller achieves substantially improved tracking accuracy. The maximum position error is 0.34 m, representing a 46.9% reduction relative to the 0.64 m obtained with the MPC + PID controller. The mean position error is 0.17 m, corresponding to a 70.7% decrease compared with the 0.58 m of the baseline method. The root mean square error is 0.20 m, indicating a 65.5% reduction relative to the 0.58 m of the baseline method. These results indicate that the proposed control method effectively compensates for hydraulic system disturbances, improves speed stability, and supports high-precision straight-line trajectory tracking.

Under the curved-trajectory scenario, the absolute errors of both controllers increased because vehicle steering introduced complex disturbances, including track slip and dynamic coupling between the left and right hydraulic motors. Despite these effects, the proposed controller consistently maintained a performance advantage: the maximum position error was 1.8619 m, representing a 14.9% reduction compared with 2.1894 m for the conventional scheme; the mean error was 0.9775 m, corresponding to a 6.5% decrease relative to 1.0453 m; and the RMSE was 1.0487 m, achieving a 10.1% reduction compared with 1.1667 m. The improved accuracy under curved conditions further confirms the robustness of the proposed hierarchical control architecture. During steering with constraints, Laguerre-MPC continues to generate accurate steering-angle and speed commands at low computational complexity. In addition, the identification model accurately captures the nonlinear characteristics of the hydraulic motors, thereby suppressing pressure fluctuations and rotational-speed deviations in the hydraulic system during steering and sustaining trajectory-tracking performance under complex operating conditions.

Vehicle experiments indicate that the proposed controller improves trajectory-tracking accuracy and demonstrates strong engineering applicability.

Conclusions and discussion

To address the high computational complexity of MPC for hydraulically driven tracked unmanned vehicles and the difficulty of obtaining an accurate dynamic model of hydraulic drive systems using conventional approaches, a hierarchical control architecture is developed to enhance trajectory-tracking performance.

In the upper-layer design, Laguerre orthogonal basis function-based MPC (Laguerre-MPC) is applied to vehicle kinematic control. By exploiting the properties of Laguerre orthogonal basis functions, the control variables are effectively reduced in dimension, which substantially decreases the computational burden and mitigates the real-time limitations encountered when MPC is implemented on hydraulically driven tracked unmanned vehicles.

In the lower-layer design, to overcome the limitations of traditional physical-based modeling in representing hydraulic-motor nonlinearities, including high complexity, limited accuracy, and poor adaptability to practical engineering scenarios, a Hammerstein-Wiener model is adopted to describe the current-speed relationship of the hydraulic motors. PID control is further integrated to provide real-time disturbance compensation, ensuring reliable execution of the upper-layer trajectory-tracking commands.

Future work will further extend and refine the proposed control architecture: (1) for modeling the current-rotational speed characteristics of hydraulic motors, physics-informed neural networks will be introduced to achieve high-precision identification of hydraulic-system dynamics; (2) for data acquisition, the single unidirectional incremental excitation signal and bench tests will be replaced by data collection under typical operating conditions during real-vehicle ground driving; (3) for track slip and vehicle-terrain interaction dynamics, reinforcement learning will be employed to adaptively optimize the track-ground interaction model, improving anti-slip robustness in off-road environments; and (4) multi-sensor fusion integrating lidar and camera data will be incorporated to enable real-time environmental perception and autonomous navigation in complex dynamic scenarios. These developments are expected to further improve the autonomous control system of hydraulically driven tracked unmanned vehicles and facilitate engineering deployment.

References

  1. 1. He M, Yue X, Zheng Y, Chen J, Wu S, Heng Z, et al. State of the art and future trends in obstacle-surmounting unmanned ground vehicle configuration and dynamics. Robotica. 2023;41(9):2625–47.
  2. 2. Zhou X, He J, He Q, Ren C, Bhushan, He M. Motion Kinematics Analysis of a Horse Inspired Terrain-Adaptive Unmanned Vehicle With Four Hydraulic Swing Arms. IEEE Access. 2020;8:194351–62.
  3. 3. Wang J, Liu Z, Chen H, Zhang Y, Zhang D, Peng C. Trajectory Tracking Control of a Skid-Steer Mobile Robot Based on Nonlinear Model Predictive Control with a Hydraulic Motor Velocity Mapping. Applied Sciences. 2023;14(1):122.
  4. 4. Zou T, Angeles J, Hassani F. Dynamic modeling and trajectory tracking control of unmanned tracked vehicles. Robotics and Autonomous Systems. 2018;110:102–11.
  5. 5. Chu D, Li H, Zhao C, Zhou T. Trajectory Tracking of Autonomous Vehicle Based on Model Predictive Control With PID Feedback. IEEE Trans Intell Transport Syst. 2022;:1–12.
  6. 6. Xu S, Peng H. Design, Analysis, and Experiments of Preview Path Tracking Control for Autonomous Vehicles. IEEE Trans Intell Transport Syst. 2020;21(1):48–58.
  7. 7. Li Q, He H, Hu M, Wang Y. Spatio-Temporal Joint Trajectory Planning for Autonomous Vehicles Based on Improved Constrained Iterative LQR. Sensors (Basel). 2025;25(2):512. pmid:39860882
  8. 8. He Y, Cao Z, Mao J, Liang K, Zhang C. Adaptive Super-Twisting Sliding Mode Control With Disturbance Compensation for Speed Regulation of PMSM System. IEEE Control Syst Lett. 2024;8:3410–5.
  9. 9. Zhang L, Zhang J, Liu S, Ren C, Kang Y. Adaptive Backstepping Fuzzy Lateral Motion Control Approach for Autonomous Vehicles. IEEE Trans Transp Electrific. 2024;10(2):4279–89.
  10. 10. Han X, Zhao X, Xu X, Mei C, Xing W, Wang X. Trajectory tracking control for underactuated autonomous vehicles via adaptive dynamic programming. Journal of the Franklin Institute. 2024;361(1):474–88.
  11. 11. Yu S, Hirche M, Huang Y, Chen H, Allgöwer F. Model predictive control for autonomous ground vehicles: a review. Auton Intell Syst. 2021;1(1):4.
  12. 12. Stano P, Montanaro U, Tavernini D, Tufo M, Fiengo G, Novella L, et al. Model predictive path tracking control for automated road vehicles: A review. Annual Reviews in Control. 2023;55:194–236.
  13. 13. Li R, Dong H, Gou J, Huang X, Li Z, Sun N. Research on Trajectory Tracking Control of Intelligent Vehicle Based on PSO-MPC Algorithm. In: 2022 2nd International Conference on Algorithms, High Performance Computing and Artificial Intelligence (AHPCAI), 2022. 148–53. https://doi.org/10.1109/ahpcai57455.2022.10087391
  14. 14. Wang H, Liu B, Ping X, An Q. Path Tracking Control for Autonomous Vehicles Based on an Improved MPC. IEEE Access. 2019;7:161064–73.
  15. 15. You Y, Yang Z, Zhuo H, Sui Y. Research on ground mobile robot trajectory tracking control based on MPC and ANFIS. Control Engineering Practice. 2024;152:106040.
  16. 16. Guo N, Liu J, Li J, Chen W, Zhang Y, Lu Q, et al. Handling-Stability Control for Distributed Drive Electric Vehicles via Lyapunov-Based Nonlinear MPC Algorithm. IEEE Trans Transp Electrific. 2025;11(2):6615–28.
  17. 17. Botes W, Botha TR, Els PS. Real-time lateral stability and steering characteristic control using non-linear model predictive control. Vehicle System Dynamics. 2022;61(4):1063–85.
  18. 18. Feng J, Jia Y, Gao W, Cai P, Zhang K, Ai C, et al. Sliding Mode Control of Spool Position for a Lead-Type Electro-Hydraulic Proportional Multi-Way Valve Based on Disturbance Observation. Machines. 2025;13(9):774.
  19. 19. He Z, Ji YZ, Yun FW. Electro-hydraulic position servo system based on sliding mode active disturbance rejection compound control. Proc Inst Mech Eng Part C-J Mech Eng Sci. 2022;236(5):2089–98.
  20. 20. Xu J, Du H, Zhou S, Wei L, Chen P, Zheng Y. Energy-efficient design and power flow analysis of electro-hydraulic steering systems for heavy-duty wheeled vehicles via parameter identification. Energy. 2025;322:135562.
  21. 21. Hulttinen L, Koivumaki J, Mattila J. Parameter identification for improved performance of model-based control of hydraulic manipulators. In: 2019 IEEE International Conference on Cybernetics and Intelligent Systems (CIS) and IEEE Conference on Robotics, Automation and Mechatronics (RAM), 2019. 124–9. https://doi.org/10.1109/cis-ram47153.2019.9095831
  22. 22. Chen M, Li Y, Ma B. Model identification and motion control of hydrostatic driven tracked vehicles. Transactions of Beijing Institute of Technology. 2024;44(11):1175–83.
  23. 23. Zhang CL, Zhao YX, Zhang P. Model parameter identification of electrostatic servo system based on genetic algorithm. Missiles and Space Vehicles. 2020;1:72–7.
  24. 24. Xu K, Zhu DL, Mei ZQ. Research on the control model of asymmetric hydraulic cylinder servo-pump control system and its parameter identification. Journal of Mechanical & Electrical Engineering. 2019;36(5):524–8.
  25. 25. Wang S, Guo J, Mao Y, Wang H, Fan J. Research on the Model Predictive Trajectory Tracking Control of Unmanned Ground Tracked Vehicles. Drones. 2023;7(8):496.
  26. 26. Kebbati Y, Puig V, Ait-Oufroukh N, Vigneron V, Ichalal D. Optimized adaptive MPC for lateral control of autonomous vehicles. In: 2021 9th International Conference on Control, Mechatronics and Automation (ICCMA), 2021. 95–103. https://doi.org/10.1109/iccma54375.2021.9646218
  27. 27. Wang LP. Model predictive control system design and implementation using MATLAB. London: Springer. 2009.