Next Article in Journal
Theoretical Analysis of Plate-Type Thermoelectric Generator for Fluid Waste Heat Recovery Using Thermal Resistance and Numerical Models
Next Article in Special Issue
Fractional Sliding Mode Observer Control Strategy for Three-Phase PWM Rectifier
Previous Article in Journal
A Study on the Performance Improvement of a Conical Bucket Detection Algorithm Based on YOLOv8s
Previous Article in Special Issue
Distributed-Drive Vehicle Lateral-Stability Coordinated Control Based on Phase-Plane Stability Region
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Decoupled Adaptive Motion Control for Unmanned Tracked Vehicles in the Leader-Following Task

1
School of Electrical and Control Engineering, North China University of Technology, Beijing 100144, China
2
Jiangsu Industrial Innovation Center of Intelligent Equipment Co., Ltd., Changzhou 213300, China
3
Anhui Ankai Automobile Co., Ltd., Hefei 230000, China
*
Author to whom correspondence should be addressed.
World Electr. Veh. J. 2024, 15(6), 239; https://doi.org/10.3390/wevj15060239
Submission received: 21 April 2024 / Revised: 19 May 2024 / Accepted: 27 May 2024 / Published: 30 May 2024
(This article belongs to the Special Issue Intelligent Electric Vehicle Control, Testing and Evaluation)

Abstract

:
As a specific task for unmanned tracked vehicles, leader-following imposes high-precision requirements on the vehicle’s motion control, especially the steering control. However, due to characteristics such as the frequent changes in off-road terrain and steering resistance coefficients, controlling tracked vehicles poses significant challenges, making it difficult to achieve stable and precise leader-following. This paper decouples the leader-following control into speed and curvature control to address such issues. It utilizes model reference adaptive control to establish reference models for the speed and curvature subsystems and designs corresponding parameter adaptive control laws. This control method enables the actual vehicle speed and curvature to effectively track the response of the reference model, thereby addressing the impact of frequent changes in the steering resistance coefficient. Furthermore, this paper demonstrates significant improvements in leader-following performance through a series of simulations and experiments. Compared with the traditional PID control method, the results shows that the maximum following distance has been reduced by at least approximately 12% (ensuring the ability to keep up with the leader), the braking distance has effectively decreased by 22% (ensuring a safe distance in an emergency braking scenario and improving energy recovery), the curvature tracking accuracy has improved by at least 11% (improving steering performance), and the speed tracking accuracy has increased by at least 3.5% (improving following performance).

1. Introduction

Due to their low operational requirements and strong off-road mobility, unmanned tracked vehicles with leader-following capabilities are valuable in missions, such as reconnaissance, logistics, and disaster relief [1,2,3,4]. However, the leader-following task poses considerable control challenges, making it difficult to enhance the vehicle’s performance. On the one hand, the distance between the unmanned vehicle and the leader should be maintained at a reasonable value [5,6,7,8]. Excessive distance increases the risk of losing track, while too little distance may lead to collisions when the leader stops abruptly. The orientation of the unmanned vehicle also needs to be stably controlled to meet the requirements of the leader perception system [9,10,11,12]. On the other hand, the dynamic characteristics of tracked vehicles are complex, with significant coupling between longitudinal and lateral control, and the dramatic changes in load resistance in off-road environments increase the difficulty of vehicle motion control [13,14,15,16,17,18]. Therefore, leader-following control for unmanned tracked vehicles poses a considerable challenge.
The existing relative research can be broadly categorized into two types: one is the study of following performance and maneuverability of wheeled vehicles or unmanned robots, and the other is the study of motion control for unmanned tracked vehicles. Dasgupta et al. focused on the platooning of Heavy Duty Vehicles (HDVs), utilizing a PID controller to enhance tracking performance through strategies for platoon merging and splitting [19]. Akopov et al. introduced a novel parallel real-coded genetic algorithm that integrates a fuzzy transportation system model to improve the lane-changing maneuverability of unmanned ground vehicles [20]. Liang et al. developed a distributed control architecture for connected and automated vehicles (CAVs), where the upper layer addresses vehicle-cruising and vehicle-following maneuvers, and the lower layer handles detailed motion control [21]. Cosgun et al. introduced a method enabling a mobile robot to autonomously follow a person, which involves a task-dependent goal function that delineates the desirable areas for the robot in relation to the person [22]. Satake et al. used the SIFT feature for the identification of a person and created a distance-dependent appearance model to follow a specific person [23]. While the previous research offers insights into the study of the leader-following task, there is a notable lack of studies dedicated to the tracked vehicles.
In addition, research on the motion control of tracked vehicles can be categorized into four main types: classical PID control, intelligent algorithm control, modern control, and observer-based control [24,25,26,27]. Xiong et al. applied a model-based PID three-degrees-of-freedom method with backstepping control and demonstrated its stability through Lyapunov theory [28]. Zou et al. established a control method using an improved PID-based backstepping approach by estimating the pose and attitude of the vehicle platform, along with its inflection point velocity and angular velocity [29]. Although classical PID controllers are widely used, their limitation lies in their dependence on fixed tuning parameters, which may impact overall performance. Zheng et al. proposed a Reinforcement Learning (RL) control method that integrates path planning, trajectory tracking, and balance control within one framework [30]. Due to algorithm complexity and high computational requirements, intelligent control methods are often constrained by hardware implementation. Amokrane et al. proposed a system design of the leader-following formation active disturbance rejection control system for unmanned tracked vehicles. Because of the control errors, they designed the active disturbance rejection controller (ADRC) for the lateral and longitudinal channels of unmanned tracked vehicles [31]. However, observer-based techniques increase the complexity of the control system and exhibit poor robustness in data results. Wang et al. utilized the side track velocities as control inputs and established a Model Predictive Controller (MPC) using the S-function after constraining the control variables [32]. However, due to challenges in accurately representing the tracked vehicle model, MPC methods may encounter control deviations from model inaccuracies. In summary, considering factors such as vehicle performance, robustness, computational requirements, and complexity, all the aforementioned algorithms have certain drawbacks, and the model reference adaptive control (MRAC) method has better applicability in dealing with such issues.
This paper aims to address the control of tracked vehicles to maintain good leader-following performance while ensuring the safety of the leader and the stability of the vehicle. Given the unknown and dynamically changing terrain of off-road conditions and the variability in steering resistance coefficients, this study aims to address the control precision issue in the leader-following task for unmanned tracked vehicles using a model reference adaptive control method. The main contributions of this paper are as follows:
  • Geometric relations are utilized to parse the leader-following task as motion control for tracked vehicles.
  • By effective transformations, the motion control of tracked vehicles is decoupled into the speed closed-loop control subsystem and the curvature closed-loop control subsystem. This decoupling ensures that both subsystems satisfy the mathematical conditions of model reference adaptive control, and corresponding reference models are designed.
  • For each subsystem, a reasonable parameter adaptive algorithm is designed. This ensures stable closed-loop system control under conditions where the rolling resistance and steering resistance coefficients are unknown and frequently changing. The actual speed and curvature outputs effectively converge to the reference model’s output, achieving stable control of the speed and curvature. This approach enhances the vehicle’s steering performance and minimizes the following distance, ultimately achieving the expected outcomes that align with the leader-following motion.
The main framework of this paper is as follows: Section 2 involves the modeling of leader-following for unmanned tracked vehicles. Section 3 proposes the specific model reference adaptive control (MRAC) strategy. Section 4 validates the effectiveness of the proposed method through simulations and experiments. Section 5 provides the conclusion of this paper.

2. Modeling for Leader-Following of Tracked Vehicles

2.1. Leader-Following Model

The fundamental task of the leader-following function is as follows: The leader (human) walks or runs at will on the ground, while the unmanned tracked vehicle carries supplies and autonomously follows the leader. Two coordinate systems are established: one fixed on the ground as the geodetic coordinate system O X Y and the other fixed on the unmanned tracked vehicle as the follower coordinate system O r X r Y r . In the follower coordinate system, O r is located at the geometric center of the tracked vehicle, with the Y r -axis pointing toward the front of the vehicle and the X r -axis pointing toward the right side of the vehicle. θ represents the angle between the Y r -axis of the follower coordinate system and the X-axis of the geodetic coordinate system while R denotes the steering radius of the arc trajectory as the tracked vehicle travels toward the leader. The leader-following motion and coordinate systems are shown in Figure 1.
The coordinates of the leader in the geodetic coordinate system vary arbitrarily based on the basic characteristics of leader motion. The unmanned tracked vehicle needs to obtain the relative coordinate position X r i and Y r i of the leader in O r X r Y r through its leader detection unit and then reasonably control its speed and curvature through the motion control unit, so that the unmanned tracked vehicle can consistently follow the leader. During the following, the head of the vehicle is oriented toward the leader as far as possible, and the position of the vehicle closely follows the coordinates in the geodetic coordinate system as accurately as possible, ensuring a reasonable distance between the vehicle and the leader [33]. During the following, it is required that X r approaches 0 and Y r remains within a reasonable range based on the leader’s speed. When the leader abruptly stops, the tracked vehicle must promptly respond to ensure a safe braking distance. The specific tracking targets are as follows:
x r i 0 y r i Φ Φ = f x r i , y r i , x ˙ r i , y ˙ r i , v
where Φ represents the optimal preset following distance to the leader, and its value is dependent on the leader’s speed ( x ˙ r i , y ˙ r i ); v is the current speed of the tracked vehicle. The parameters can be adjusted based on actual conditions to make the following distance more reasonable.

2.2. Dynamics Model of the Tracked Vehicle

As mentioned above, the geodetic coordinate system is denoted as O X Y , and the follower coordinate system of the tracked vehicle is denoted as O r X r Y r . The resultant forces acting on the tracked vehicle are shown in Figure 2.
In Figure 2, ω is the steering angular velocity, M is the steering resistance torque, F 1 and F 2 are the tractive force of the left and right tracks, and F R 1 and F R 2 are the rolling resistance of each track. The dynamics model of the tracked vehicle is as follows [14]:
m v ˙ = F 1 + F 2 F R 1 F R 2 J ω ˙ = F 2 F 1 · B 2 M M = μ max m g L 4 0.925   +   0.15 ρ ρ = 1 τ B = v B ω F 1 φ N 1 , F 2 φ N 2 F R 1 + F R 2 = f m g
where ρ represents the relative steering radius; v is the vehicle’s center velocity; τ is the curvature, which is the reciprocal of the steering radius; m is the total vehicle mass; J is the moment of inertia; L is the track contact length; B is the center track distance; μ m a x is the steering resistance coefficient for a specific road surface; φ is the adhesion coefficient; f is the rolling resistance coefficient; and N 1 and N 2 are the ground pressures on the left and right tracks. To simplify the calculations, the rolling resistance experienced by the left and right tracks is considered as a whole.
It is worth noting that the driving force of the vehicle is provided by the motor [34]:
F i = T e i i c r z
where the corner marks i = 1 , 2 , respectively, denoting the left and right sides; T e i is the torque motor; i c is the gear ratio from the motor to the driving wheel; and r z is the driving wheel radius.
Additionally, the braking force provided by the motor is often constrained by its maximum braking torque and power, especially in emergency braking conditions, where hydraulic braking force may be required as a supplement. Considering the motor braking characteristics, a conventional braking force distribution strategy is adopted as follows [35]:
F brake = T e i c r z , F brake < F e _ max T e _ max i c r z + F h , F brake F e _ max
where F brake is the actual braking force, F e _ max represents the maximum torque that the electric motor can provide, F brake is the target braking force, and F h is the hydraulic braking force. When the target braking force is less than the maximum braking force that the electric motor can provide, the electric motor supplies all the braking force. When the target braking force is greater than or equal to the maximum braking force that the electric motor can provide, to ensure the safety of the vehicle braking, the electric motor outputs the maximum torque to provide the maximum braking force, with the remaining portion supplemented by hydraulic braking force.

2.3. Linear Equivalent Model

During the motion process, considerations primarily involve terrain changes and steering resistance coefficient variations, resulting in load fluctuations. Because the steering curvature can better reflect changes in the heading angle of tracked vehicles, aiding the vehicle in rapidly adjusting toward the leader, it is more suitable to choose the curvature as one of the state variables. Therefore, with the speed (v) and curvature ( τ ) as the state variables, the dynamics model (2) is reconstructed as follows:
v ˙ = F 1   +   F 2 m f g τ ˙ = F 2     F 1 B 2 J M J · 1 v F 1   +   F 2 m f g · τ v M = μ max m g L 4 0.925   +   0.15 τ B
The MRAC we chose generally requires the controlled object to be a linear, single-input, single-output scleronomous system. It is necessary to process the dynamics model separately with v and τ as the state variables to obtain the equivalent inputs F v and F τ for an adaptive feedback control system. Therefore, by performing a Taylor expansion of the steering resistance torque M at point τ 0 , we have:
M = μ max m g L B τ 3.7 B τ + 0.6 = μ max m g L 3.7 · 3.7 B τ 0 3.7 B τ 0 + 0.6 2 + 0.6 · 3.7 B 3.7 B τ 0 + 0.6 2 τ
The actual steering process can be viewed as combining many small segments of τ , each representing a first-order linear steady-state equation under a specific τ 0 . Therefore, combining with (5) and (6), the dynamics model is reformulated as follows:
v ˙ = ψ 1 F v ψ 2 v τ ˙ = ζ 1 F τ ζ 2 τ F v = F 1   +   F 2 m f g ψ 1 = 1 ψ 2 = 0 F τ = F 2     F 1 B 2 J v 1 J v · μ max m g L 3.7 · 3.7 B τ 0 3.7 B τ 0   +   0.6 2 ζ 1 = 1 ζ 2 = 1 J v · μ max m g L 3.7 · 0.6 · 3.7 B 3.7 B τ 0   +   0.6 2 + F 1   +   F 2 m v f g v
where F v and F τ are equivalent inputs to the system, as they are only related to the actual control inputs F 1 + F 2 through constant terms. At this point, the construction of the linear equivalent model is achieved.

3. Control Strategy

3.1. Integrated Control Algorithm Structure

The tracked vehicle’s motion is controlled through the combined action of lateral and longitudinal forces. A rational decoupling control strategy is necessary to improve the control precision and meet the requirements of the leader-following task. Moreover, in the actual control of the vehicle, such parameters as f and μ max are unknown and time-varying; especially, the steering resistance torque is in the unpredictable changes. Therefore, if an open-loop approach is used to calculate the target drive torque T i , the adaptability of the strategy could be limited. So, it is crucial to design a closed-loop feedback control structure to improve the robustness and stability.
The adaptive control strategy devised in this study involves the following steps: First, the control signals from the leader detection unit are analyzed to extract the target vehicle speed ( v ) and the target steering curvature ( τ ). Then, both of them are subject to the closed-loop control in comparison with the actual vehicle speed (v) and steering curvature ( τ ) so as to enable adaptive adjustment to the reasonable target driving force F i .
Despite adopting a closed-loop control structure for v and τ , there are still significant challenges in designing closed-loop algorithms for leader-following tasks. The main reasons include the following:
  • The interaction mechanism between the tracks and the ground is highly complex, leading to such characteristics as indefinite inertia, unknown parameters, nonlinearity, and multiple-input multiple-output (MIMO) in the dynamics model of the tracked vehicles;
  • Human behavior often exhibits significant uncertainties, such as sudden changes in speed and direction, so highly adaptive control algorithms are required;
  • The strong coupling between v and τ results in mutual influences on the closed-loop control over the two parameters.
To address the above challenges, this study proposed a control strategy by employing the model reference adaptive control (MRAC), which utilizes the leader’s information and the vehicle’s feedback to adjust the control objectives. With a reference model for parameter-determined ideal vehicle dynamics used to estimate road loads, the motor torque is dynamically adjusted to ensure real-time tracking of the actual speeds and curvatures based on the reference model’s speed and curvature outputs. This adaptive closed-loop control is designed to achieve stable leader-following control. The control flowchart is shown in Figure 3, which indicates the reference system parameters with subscript “m” and the actual system parameters with subscript “p”.
The main components of the control structure include the “leader-following control law; computation of target speed and curvature; reference dynamics model; adaptive control law; and computation of target driving forces”. The specific solution process is as follows: Initially, to parse the leader’s signals, resolve them into v and τ ; subsequently, based on v and τ , compute a set of v m , F v m , τ m , and F τ m in the speed control subsystem and the curvature control subsystem separately; then, using the adaptive control law module based on the reference vehicle speed and curvature, calculate the actual required values of F v and F τ ; afterward, the adaptive solving system controls the required target driving forces F 1 and F 2 , which are then transformed to obtain the target driving torques T 1 and T 2 . These values are sent to the motor controller, hydraulic brake control valve, and other related devices, and the actual vehicle would operate under the control state at the speed of v p and steering curvature of τ p .

3.2. Leader-Following Control Law

As mentioned above, the leader-following control law is based on the relative coordinate position ( x r i and y r i ) of the leader in O r x r y r . The specific control law is as follows: If the leader is directly in front of the tracked vehicle, the vehicle will travel straight toward the leader; if the leader is not directly in front of the tracked vehicle (i.e., y r i is not close to 0), the unmanned vehicle will typically go along a smooth circular curve to the leader under a controlled state. Using curvatures instead of the steering radius for control can avoid the unmanageable situation that the steering radius value is infinite under the straight driving condition.
To ensure a reasonable following distance, i.e., to keep up with the leader while maintaining a safe distance, the target vehicle speed and curvature for the tracked vehicle shall be calculated in relation to the relative distance and speed between the leader and the vehicle. Thus, the control law of the target steering curvature ( τ ) and the target speed ( v ) is given by:
v = k 1 · x ˙ r i 2 + y ˙ r i 2 + k 2 · S i τ = 2 sin α S i = 2 sin arctan x r i y r i x r i 2   +   y r i 2
where α is the angle between the vehicle’s orientation and the following target at time i, S i is the position of the vehicle relative to the following target, k 1 is the current relative speed coefficient of the vehicle, and k 2 is the distance coefficient of the following target.

3.3. Reference Model

The purpose of constructing a reference model is to provide a standard or ideal performance benchmark for the control subsystem. This benchmark enables the control system to continuously adjust the actual speed and curvature of the tracked vehicle, ensuring that they closely track the reference model’s outputs in real time. Using (5), the reference dynamics model is designed as follows:
v ˙ m = F 1 m   +   F 2 m m f g τ ˙ m = F 2 m     F 1 m B 2 J M J · 1 v F 1 m   +   F 2 m m f g · τ v m M = μ max m g L 4 0.925   +   0.15 τ m B
This model is designed as a nonlinear dual-input and dual-output state-space system. The input variables of the system are F 1 m and F 2 m , the state variables are v m and τ m , and the output variables of the system are v m and τ m . Other parameters can be preset as close to the vehicle’s actual conditions. Under the equilibrium condition of (9), the reference driving forces F 1 m and F 2 m are obtained as follows:
F 1 m = f 2 μ max 4 B 0.925   +   0.15 τ B · m g F 2 m = f 2 + μ max 4 B 0.925   +   0.15 τ B · m g
Substitute the equivalent inputs into the reference model:
v ˙ m = ψ 1 m F v m ψ 2 m v m , ( ψ 2 m > 0 )
In addition, ψ 1 m and ψ 2 m (should be greater than zero) need to be designed based on closed-loop poles and stability margins to ensure the stability and rapid response of the reference system’s v m response. The system is also a scleronomous system.
Similar processing is applied to the actual system, and the following results can be obtained:
v ˙ p = ψ 1 p F v p ψ 2 p v p
where ψ 1 p and ψ 2 p are determined by the actual terrain and are generally not equal to the values of the corresponding parameters in the reference system. Due to these differences, we need to design an adaptive algorithm to eliminate the influence and ensure the system’s robustness. Of course, if the values of the reference system are very close to the actual system, the difficulty of adapting the algorithm to adjust the parameters will be lower.
The algorithm design for the equivalent input of the dynamics equations with the vehicle speed as the state variable is based on excluding constant terms to ensure closed-loop pole placement:
F v m = F 1 m + F 2 m m f g
Similar handling is applied to the reference system for the curvature, resulting in:
τ ˙ m = ζ 1 m F τ m ζ 2 m τ m , ( ζ 2 m > 0 )
In addition, ζ 1 m and ζ 2 m (should be greater than zero) need to be designed based on closed-loop poles and stability margins to ensure the stability and rapid response of the reference system’s τ m response. The system is also a scleronomous system. Similar processing is applied to the actual system, the actual dynamics model, and the following results can be obtained:
τ ˙ p = ζ 1 p F τ p ζ 2 p τ p
where ζ 1 p and ζ 2 p are determined by the actual environment and are generally not equal to the values of the corresponding parameters in the reference system. Similarly, an adaptive algorithm is designed to eliminate their influence and ensure the robustness of the system.
The following is the algorithm for the equivalent input of the dynamics equation with the curvature as the state variable:
F τ m = F 2 m F 1 m B 2 J v m 1 J v m · μ max m g L 3.7 · 3.7 B τ m 3.7 B τ m + 0.6 2
Due to the skillful design of F v m and F τ m , it ensures that v m = v and τ m = τ , thereby achieving the tracking of the reference system response to the leader-following control intentions.

3.4. Motion Adaptive Control Law

The purpose of designing the adaptive control law is to determine the actual inputs F v p and F τ p required for controlling the adaptive solving system based on F v , F τ , v m , and τ m and the feedback of the actual motor speed, ultimately deriving the motor torque.
The closed-loop control method of the subsystem is shown in Figure 4.
The adaptive algorithm for the speed closed-loop control with v as the state variable is as follows:
F v p = χ 1 F v m + χ 2 v p e v = v p v m χ ˙ 1 = k v e v F v m χ ˙ 2 = k v e v v p
where e v is the error between the reference speed subsystem v m and the actual speed subsystem v p . The input F v p acts on the actual system, and the control result is that e v converges to zero, achieving the servo of v p to v m . The parameters χ 1 and χ 2 are adaptively adjusted based on e v , forming the control algorithm. When the error is significant, the change rate of χ 1 and χ 2 is significant, ensuring rapid error convergence. As the error approaches zero, the change rate of χ 1 and χ 2 becomes small, ensuring that the input F v p quickly stabilizes without oscillation.
Similarly, the adaptive algorithm for the speed closed-loop control with τ as the state variable is as follows:
F τ p = γ 1 F τ m + γ 2 τ p e τ = τ p τ m γ ˙ 1 = k τ e τ F τ m γ ˙ 2 = k τ e τ τ p
where e τ is the error between the reference curvature subsystem v m and the actual curvature subsystem v p . F v p affects the input for the straight-line speed, while F τ p influences the steering angular velocity. Utilizing these inputs, the target driving forces F 1 and F 2 are calculated with the following equations:
F v p = F 1   +   F 2 m f g F τ p = F 1     F 2 B 2 J v p 1 J v p · μ max m g L 3.7 · 3.7 B τ p 3.7 B τ p   +   0.6 2
Through the adjusting effect of the adaptive law, e v between v m and v p can rapidly converge to zero, and e τ between τ m and τ p can also quickly converge to zero. These results in v p and τ p closely follow v m and τ m , ensuring that the actual vehicle response effectively follows the response of the reference system. Thus, v p and τ p can well track v and τ under complex road conditions.
Furthermore, in the actual control process, the driving and braking forces of the tracked vehicle are distributed according to the distribution law mentioned before.

3.5. Proof of Control System Stability

Stability is a crucial characteristic for the regular operation of a system, and Lyapunov theory serves as a fundamental theoretical basis for proving system stability. Therefore, it is necessary to utilize Lyapunov theory to demonstrate the stability of the proposed control system in the final analysis. However, the leader-following control law is based on a linear look-up table, which does not affect the stability of the system and does not require extensive proof. In control subsystems, the primary considerations are the stability of v p and τ p . For the speed subsystem, according to (17), e v , χ 1 , and χ 2 are relative variables to v p , and the Lyapunov function can be chosen as:
V ( e v , χ 1 , χ 2 ) = e v 2 2 + ψ 1 p 2 k v · χ 1 ψ 1 m ψ 1 p 2 + ψ 1 p 2 k v · χ 2 ψ 2 p ψ 2 m ψ 1 p 2
Its derivative value is:
V ˙ = e v e ˙ v + ψ 1 p k v · χ 1 ψ 1 m ψ 1 p · χ ˙ 1 + ψ 1 p k v · χ 2 ψ 2 p     ψ 2 m ψ 1 p · χ ˙ 2 = e v v ˙ p v ˙ m ψ 1 p · χ 1 ψ 1 m ψ 1 p · e v F v m ψ 1 p · χ 2 ψ 2 p     ψ 2 m ψ 1 p · e v v p = e v v ˙ p v ˙ m ψ 1 p χ 1 ψ 1 m · e v F v m ψ 1 p χ 2 + ψ 2 m ψ 2 p · e v v p = e v ψ 1 p F v p ψ 2 p v p ψ 1 m F v m + ψ 2 m v m ψ 1 p χ 1 ψ 1 m · e v F v m ψ 1 p χ 2 + ψ 2 m ψ 2 p · e v v p = e v ψ 2 m v m ψ 2 m v p = ψ 2 m e v 2 < 0
Similarly, for the curvature subsystem according to (18), the Lyapunov function with τ as the state variable can be chosen as:
V ( e τ , γ 1 , γ 2 ) = e τ 2 2 + ζ 1 p 2 k τ · γ 1 ζ 1 m ζ 1 p 2 + ζ 1 p 2 k τ · γ 2 ζ 2 p ζ 2 m ζ 1 p 2
Its derivative value is:
V ˙ = e τ e ˙ τ + ζ 1 p k τ · γ 1 ζ 1 m ζ 1 p · γ ˙ 1 + ζ 1 p k τ · χ 2 ζ 2 p     ζ 2 m ζ 1 p · γ ˙ 2 = e τ τ ˙ p τ ˙ m ζ 1 p · γ 1 ζ 1 m ζ 1 p · e τ F τ m ζ 1 p · γ 2 ζ 2 p     ζ 2 m ζ 1 p · e τ τ p = e τ τ ˙ p τ ˙ m ζ 1 p γ 1 ζ 1 m · e τ F τ m ζ 1 p γ 2 + ζ 2 m ζ 2 p · e τ τ p = e τ ζ 1 p F τ p ζ 2 p τ p ζ 1 m F τ m + ζ 2 m τ m ζ 1 p γ 1 ζ 1 m · e τ F τ m ζ 1 p γ 2 + ζ 2 m ζ 2 p · e τ τ p = e τ ζ 2 m τ m ζ 2 m τ p = ζ 2 m e τ 2 < 0
Thus, the subsystems’ stability is proved.

4. Experimental Results

4.1. Simulation Validation

The simulations were performed using Matlab/Simulink and RecurDyn to validate the effectiveness of the proposed algorithm for the leader-following task, as shown in Figure 5. Three different conditions were designed to include straight-line driving combined with turning, continuous turning, and emergency braking, thereby covering the principal motion scenarios of the leader-following task. Furthermore, a comparative analysis was conducted on the simulation results between the MRAC control strategy proposed in this paper and the traditional PID control strategy. The simulation model is constructed based on the actual parameters of the platform, with its main parameters as shown in Table 1.

4.1.1. Condition 1

Condition 1 involves the general movements of unmanned tracked vehicles in the leader-following task, including linear acceleration, deceleration, and constant-speed turning. The leader starts from a position 2 m away from the tracked vehicle. Within the first 10 s, the leader first performs a uniform acceleration motion in the positive y-axis direction at a speed of 2 m/s2, then maintains a uniform motion at a speed of 7 m/s, and then reduces the speed to 2.5 m/s. From 10 s to 20 s, a constant angular velocity is applied for a clockwise steering motion, resulting in a 90-degree turn with a steering radius of 15 m. From 20 s to 30 s, the vehicle undergoes another variable-speed motion, starting with acceleration, then a constant speed, and then deceleration, while facing the positive x-direction. In the subsequent 10 s (30 s to 40 s), a constant angular velocity is applied for another 90-degree clockwise steering motion with a steering radius of 15 m. Finally, from 40 s to 50 s, the vehicle undergoes variable-speed motion in the negative y-axis direction, with the initial acceleration, constant speed, and eventual deceleration until the speed reaches 0. The experimental results are shown in Figure 6.
Figure 6 illustrates the leader-following effect of the unmanned tracked vehicle in condition 1, and Figure 7 compares the performance of the two control methods in condition 1. Compared to the PID control method, the maximum deviation between the MRAC vehicle trajectory and the leader trajectory is reduced by 6%, there is a maximum curvature error reduction of 11% and a maximum speed error reduction of 5%, and the maximum following distance is reduced by 12%. Moreover, MRAC can fully exploit the performance of the vehicle’s dual motor. MRAC performs well in straight-line motion and closely follows the leader in the steering phases, demonstrating better completion of the leader-following task than the PID control method.

4.1.2. Condition 2

Condition 2 accounts for the continuous turning scenarios in the leader-following task. The leader starts from a position 2 m away from the tracked vehicle. In the first 10 s, the leader performs a clockwise steering motion with a constant angular velocity for a 180-degree turn with a steering radius of 5 m. From 10 s to 20 s, the leader executes a counterclockwise steering motion with a constant angular velocity for a 90-degree turn with a steering radius of 4.5 m. Finally, from 20 s to 30 s, the leader performs a clockwise steering motion with a constant angular velocity for a 180-degree turn with a steering radius of 5 m. The experimental results are shown in Figure 8.
Figure 8 illustrates the leader-following effect of the unmanned tracked vehicle in simulation condition 2, and Figure 9 compares the performance of the two control methods in condition 2. In this case, the maximum deviation between the MRAC vehicle trajectory and the leader trajectory is reduced by 6.6%, there is a maximum curvature error reduction of 47% and a maximum speed error reduction of 3.5%, and the maximum following distance is reduced by 16%. Because this scenario involves low-speed control, the speed errors for both control methods are relatively small. It can be observed that the MRAC decoupling control method significantly improves the steering performance of the vehicle, even in extreme steering conditions where the PID curvature control deviation is significant, ensuring perfect following of the target curvature.

4.1.3. Condition 3

The condition of emergency braking is set up to verify the effectiveness of the proposed control algorithm in coping with unexpected situations. In this condition, the leader starts from a position 2 m away from the tracked vehicle. In the first 15 s, the leader undergoes a variable-speed motion with the initial acceleration followed by a constant speed, where the acceleration is 2 m/s2. At 15 s, the leader abruptly stops. In the event of an abrupt stop by the leader, the unmanned tracked vehicle should promptly apply the brakes and maintain a safe distance to avoid collisions. The experimental results are shown in the Figure 10.
Figure 10 compares the performance of the two control methods in test condition 3. Due to the condition involving straight-line driving and emergency braking, only the displacement in the Y-axis direction needs to be considered. During regular driving phases, both control methods can effectively follow the leader’s movements. In the emergency braking phase, the MRAC control method achieves a reduction of 22% in the braking distance, enabling it to stop at a greater distance from the leader, ensuring the safety of the leader (human). Simultaneously, during the braking process, energy recovery can be achieved through the motor, reducing the vehicle’s energy consumption.

4.2. Experimental Validation

To validate the proposed control method, the experiments were conducted on a platform featuring a dual-motor-driven unmanned tracked vehicle equipped with cameras, Lidar, and inertial navigation. The overall vehicle’s topology is shown in Figure 11. The leader-following control system of the unmanned tracked vehicle consists of the leader detection unit and the motion control unit. The leader detection unit utilizes sensors and leader perception algorithms to obtain the leader’s relative coordinates ( x r i , y r i ) and sends this information to the motion control unit. The motion control unit initially calculates the obtained information ( x r i and y r i ) into target speed and target curvature commands. Subsequently, based on the motion adaptive control algorithm, it further adjusts the vehicle’s drive and brake execution units. Finally, the adjusted commands are sent to the motor controller and control valve for execution via the CAN bus. The main parameters of the experimental platform are presented in Table 2. However, the parameter for rotational inertia is not included due to the difficulty in accurately obtaining it.
The experimental platform and visualization results are shown in Figure 12. In order to make the experimental results more intuitive, the leader is marked with a red box.
In the actual vehicle experiment, the expected motion of the leader (human) is as follows: starting from a position 5 m away from the tracked vehicle, moving forward along the x-axis for 20 m, and then initiating a counterclockwise steering motion of 180 degrees with a steering radius of 10 m. However, during the actual experiment, due to the inability of the human leader to control his movement position precisely, there is a deviation between the actual trajectory of the leader and the expected trajectory. However, as this research focuses on leader-following rather than trajectory tracing, the primary objective is for the unmanned tracked vehicle to effectively trail the real-time movement of the leader. It is worth noting that this experiment lasted for a long period, and only the previously mentioned process of the leader’s movement was recorded as the starting and ending point of the experimental results, and the results are shown in Figure 13 and Figure 14.
Figure 14 illustrates the leader-following effect of the unmanned tracked vehicle under actual vehicle experiment conditions. In the experiment, the maximum deviation between the MRAC vehicle trajectory and the leader trajectory is 0.48 m, and the maximum curvature error is 0.05 m−1. It can be observed that during straight-line movement, the following distance is positively correlated with the actual speed. During large curvature turning, the following distance is extended by approximately 0.5 m but remains within a controllable range. Therefore, in real-world scenarios, the control strategy utilized in this study can effectively control the vehicle, accomplishing the leader-following task excellently.

5. Conclusions

Due to the high precision required for motion control and the complex dynamic characteristics of unmanned tracked vehicles, achieving the leader-following task presents significant challenges. To address this issue, this paper decouples the leader-following control into speed and curvature control, utilizing model reference adaptive control (MRAC) to set up speed and curvature subsystems separately. The actual speed and curvature are continuously adjusted based on the reference model’s speed and curvature to achieve adaptive closed-loop control. The method demonstrates a significant performance improvement in the leader-following task for unmanned tracked vehicles through simulations and experiments. Compared with the traditional PID control method, the results show that the maximum following distance has been reduced by at least approximately 12% (ensuring the ability to keep up with the leader), the braking distance has effectively decreased by 22% (ensuring a safe distance in the emergency braking scenario and improving energy recovery), the curvature tracking accuracy has improved by at least 11% (improving steering performance), and the speed tracking accuracy has increased by at least 3.5% (improving following performance).

Author Contributions

Conceptualization, J.F.; methodology, J.F. and P.Y.; investigation, J.F.; writing—original draft preparation, J.F. and P.Y.; writing—review and editing, J.F.; validation, Y.L. (Yingzhe Liu) and C.C.; formal analysis, Y.L. (Yi Liu); data curation, R.L. and F.W.; resources, J.F. All authors have read and agreed to the published version of this manuscript.

Funding

This project is supported by the Chinese Scholartree Ridge Laboratory Foundations (2023-JCJQ-LB-037) and the National Laboratory for Wheeled Vehicles Foundations (2023NELEV001).

Institutional Review Board Statement

Not applicable.

Data Availability Statement

The data presented in this study are available upon request from the corresponding author.

Acknowledgments

The authors would like to acknowledge the anonymous reviewers and editors whose thoughtful comments helped to improve this manuscript.

Conflicts of Interest

Jingjing Fan, Yi Liu, Yingzhe Liu and Chang Chen are employees of Jiangsu Industrial Innovation Center of Intelligent Equipment Co., Ltd., Changzhou 213300, China. Ren Li and Falong Wang are employees of Anhui Ankai Automobile Co., Ltd., Hefei 230000, China. The paper reflects the views of the scientists, and not the company.

References

  1. Amer, N.H.; Zamzuri, H.; Hudha, K.; Kadir, Z.A. Modelling and control strategies in path tracking control for autonomous ground vehicles: A review of state of the art and challenges. J. Intell. Robot. Syst. 2017, 86, 225–254. [Google Scholar]
  2. Nguyen, V.L.; Kim, D.H.; Le, V.S.; Jeong, S.K.; Lee, C.H.; Kim, H.K.; Kim, S.B. Positioning and trajectory tracking for caterpillar vehicles in unknown environment. Int. J. Control Autom. Syst. 2020, 18, 3178–3193. [Google Scholar]
  3. Sabiha, A.D.; Kamel, M.A.; Said, E.; Hussein, W.M. Dynamic modeling and optimized trajectory tracking control of an autonomous tracked vehicle via backstepping and sliding mode control. Proc. Inst. Mech. Eng. Part I J. Syst. Control Eng. 2022, 236, 620–633. [Google Scholar]
  4. Li, R.; Fan, J.J.; Han, Z.D.; Guan, S.; Qin, Z.B. Configuration design and control of hybrid tracked vehicle with three planetary gear sets. J. Cent. South Univ. 2021, 28, 2105–2119. [Google Scholar] [CrossRef]
  5. Hu, K.; Cheng, K. Trajectory Planning for an Articulated Tracked Vehicle and Tracking the Trajectory via an Adaptive Model Predictive Control. Electronics 2023, 12, 1988. [Google Scholar] [CrossRef]
  6. Li, R.; Xiang, C.; Wang, C.; Fan, J.; Liu, C. Robust Adaptive Trajectory Tracking Control Approach for Autonomous Tracked Vehicles. Acta Armamentarii 2021, 42, 1128–1137. [Google Scholar]
  7. Zhao, Z.; Liu, H.; Chen, H.; Hu, J.; Guo, H. Kinematics-aware model predictive control for autonomous high-speed tracked vehicles under the off-road conditions. Mech. Syst. Signal Process. 2019, 123, 333–350. [Google Scholar] [CrossRef]
  8. Wang, P.; Rui, X.; Yu, H. Study on dynamic track tension control for high-speed tracked vehicles. Mech. Syst. Signal Process. 2019, 132, 277–292. [Google Scholar] [CrossRef]
  9. Qin, Z.; Chen, L.; Fan, J.; Xu, B.; Hu, M.; Chen, X. An improved real-time slip model identification method for autonomous tracked vehicles using forward trajectory prediction compensation. IEEE Trans. Instrum. Meas. 2021, 70, 1–12. [Google Scholar] [CrossRef]
  10. Kang, Y.; Zhang, Y.; Zeng, R. Path Tracking Control of Tracked Vehicles Considering Skid-steer Characteristic on Uneven Terrain. J. Cent. South Univ. 2022, 53, 491–501. [Google Scholar]
  11. Lu, J.; Liu, H.; Guan, H.; Li, D.; Chen, H.; Liu, L. Trajectory Tracking Control of Unmanned Tracked Vehicles Based on Adaptive Dual-Parameter Optimization. Acta Armamentarii 2023, 44, 960–971. [Google Scholar]
  12. Gai, J.; Liu, C.; Ma, C.; Shen, H. Steering control of electric drive tracked vehicle considering tracks’ skid and slip. Acta Armamentarii 2021, 42, 2092–2101. [Google Scholar]
  13. Wang, B.Y.; Gong, J.W.; Gao, T.Y.; Zhang, R.Z.; Chen, H.Y.; Xi, J.Q. Longitudinal and lateral path following coordinated control method of tracked vehicle based on double-layer driver model. Acta Armamentarii 2018, 39, 1675–1682. [Google Scholar]
  14. Tang, Z.; Liu, H.; Xue, M.; Chen, H.; Gong, X.; Tao, J. Trajectory Tracking Control of Dual Independent Electric Drive Unmanned Tracked Vehicle Based on MPC-MFAC. Acta Armamentarii 2023, 44, 129–139. [Google Scholar]
  15. Hu, J.; Hu, Y.; Chen, H.; Liu, K. Research on trajectory tracking of unmanned tracked vehicles based on model predictive control. Acta Armamentarii 2019, 40, 456–563. [Google Scholar]
  16. Sebastian, B.; Ben-Tzvi, P. Active disturbance rejection control for handling slip in tracked vehicle locomotion. J. Mech. Robot. 2019, 11, 021003. [Google Scholar] [CrossRef]
  17. Han, J.; Wang, F.; Wang, Y. A control method for the differential steering of tracked vehicles driven independently by a dual hydraulic motor. Appl. Sci. 2022, 12, 6355. [Google Scholar] [CrossRef]
  18. Mahalingam, I.; Padmanabhan, C. An integrated three-dimensional powertrain-vehicle dynamics model for tracked vehicle analysis. Proc. Inst. Mech. Eng. Part D J. Automob. Eng. 2023, 237, 3353–3366. [Google Scholar] [CrossRef]
  19. Dasgupta, S.; Raghuraman, V.; Choudhury, A.; Teja, T.N.; Dauwels, J. Merging and splitting maneuver of platoons by means of a novel PID controller. In Proceedings of the 2017 IEEE Symposium Series on Computational Intelligence, Honolulu, HI, USA, 27 November–1 December 2017; pp. 1–8. [Google Scholar] [CrossRef]
  20. Akopov, A.S.; Beklaryan, L.A.; Thakur, M. Improvement of Maneuverability within a Multiagent Fuzzy Transportation System with the Use of Parallel Biobjective Real-Coded Genetic Algorithm. IEEE Trans. Intell. Transp. Syst. 2022, 23, 12648–12664. [Google Scholar] [CrossRef]
  21. Liang, J.; Li, Y.; Yin, G.; Xu, L.; Lu, Y.; Feng, J.; Shen, T.; Cai, G. A MAS-Based Hierarchical Architecture for the Cooperation Control of Connected and Automated Vehicles. IEEE Trans. Veh. Technol. 2023, 72, 1559–1573. [Google Scholar] [CrossRef]
  22. Cosgun, A.; Florencio, D.A.; Christensen, H.I. Autonomous person following for telepresence robots. In Proceedings of the 2013 IEEE International Conference on Robotics and Automation, Karlsruhe, Germany, 6–10 May 2013; pp. 4335–4342. [Google Scholar]
  23. Satake, J.; Chiba, M.; Miura, J. A SIFT-based person identification using a distance-dependent appearance model for a person following robot. In Proceedings of the 2012 IEEE International Conference on Robotics and Biomimetics (ROBIO), Guangzhou, China, 11–14 December 2012; pp. 962–967. [Google Scholar]
  24. Evseev, K.B.; Kositsyn, B.B.; Kotiev, G.O.; Stadukhin, A.A.; Smirnov, I.A.; Godzhaev, Z.A. Design of the double-jointed multi-tracked vehicle steering control law providing its motion along a reference trajectory. J. Phys. Conf. Ser. 2021, 2032, 012064. [Google Scholar] [CrossRef]
  25. Cui, D.; Wang, G.; Zhao, H.; Wang, S. Research on a Path-Tracking Control System for Articulated Tracked Vehicles. Stroj. Vestn. J. Mech. Eng. 2020, 66, 311–324. [Google Scholar] [CrossRef]
  26. Shentu, S.; Xie, F.; Liu, X.J.; Gong, Z. Motion Control and Trajectory Planning for Obstacle Avoidance of the Mobile Parallel Robot Driven by Three Tracked Vehicles. Robotica 2021, 39, 1037–1050. [Google Scholar] [CrossRef]
  27. Chunming, L.; Ke, B. Modeling and Analysis of Multi-level Coupling Dynamics of Tracked Vehicle Based on Load Transfer Path. J. Mech. Eng. 2023, 59, 157–174. [Google Scholar]
  28. Xiong, H.; Chen, Y.; Li, Y.; Zhu, H.; Yu, C.; Zhang, J. Dynamic model-based back-stepping control design for-trajectory tracking of seabed tracked vehicles. J. Mech. Sci. Technol. 2022, 36, 4221–4232. [Google Scholar] [CrossRef]
  29. Zou, T.; Angeles, J.; Hassani, F. Dynamic modeling and trajectory tracking control of unmanned tracked vehicles. Robot. Auton. Syst. 2018, 110, 102–111. [Google Scholar] [CrossRef]
  30. Zheng, Q.; Tian, Y.; Deng, Y.; Zhu, X.; Chen, Z.; Liang, B. Reinforcement Learning-Based Control of Single-Track Two-Wheeled Robots in Narrow Terrain. Actuators 2023, 12, 109. [Google Scholar] [CrossRef]
  31. Amokrane, S.B.; Laidouni, M.Z.; Adli, T.; Madonski, R.; Stanković, M. Active disturbance rejection control for unmanned tracked vehicles in leader–follower scenarios: Discrete-time implementation and field test validation. Mechatronics 2024, 97, 103114. [Google Scholar] [CrossRef]
  32. 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, 496. [Google Scholar] [CrossRef]
  33. Wan, Q.; Li, Z.; Li, Y.; Ge, Z.; Wang, Y.; Wu, D. Target following method of mobile robot based on improved YOLOX. Acta Autom. Sin. 2023, 49, 1558–1572. [Google Scholar]
  34. Zeng, G.; Wang, W.; Gai, J.; Ma, C.; Li, X.; Li, H. Steering on Ramp Control Strategy of Double Motor Coupling Drive Transmission for Tracked Vehicle. Acta Armamentarii 2021, 42, 2189–2195. [Google Scholar]
  35. Zhang, L.; Liu, Q.; Wang, Z. Research on Electro-hydraulic Composite ABS Control for Four-wheel-independent-drive Electric Vehicles Based on Robust Integral Sliding Mode Control. J. Mech. Eng. 2022, 58, 243–252. [Google Scholar]
Figure 1. The schematic diagram of leader-following motion.
Figure 1. The schematic diagram of leader-following motion.
Wevj 15 00239 g001
Figure 2. Resultant forces acting on the tracked vehicle.
Figure 2. Resultant forces acting on the tracked vehicle.
Wevj 15 00239 g002
Figure 3. Overall control flowchart.
Figure 3. Overall control flowchart.
Wevj 15 00239 g003
Figure 4. Closed-loop control method of subsystem.
Figure 4. Closed-loop control method of subsystem.
Wevj 15 00239 g004
Figure 5. The simulation model of the tracked vehicle in RecurDyn.
Figure 5. The simulation model of the tracked vehicle in RecurDyn.
Wevj 15 00239 g005
Figure 6. Schematic diagram of leader-following under condition 1.
Figure 6. Schematic diagram of leader-following under condition 1.
Wevj 15 00239 g006
Figure 7. Performance comparison of two control methods under condition 1.
Figure 7. Performance comparison of two control methods under condition 1.
Wevj 15 00239 g007
Figure 8. Schematic diagram of leader-following under condition 2.
Figure 8. Schematic diagram of leader-following under condition 2.
Wevj 15 00239 g008
Figure 9. Performance comparison of two control methods under condition 2.
Figure 9. Performance comparison of two control methods under condition 2.
Wevj 15 00239 g009aWevj 15 00239 g009b
Figure 10. Performance comparison of two control methods under condition 3.
Figure 10. Performance comparison of two control methods under condition 3.
Wevj 15 00239 g010
Figure 11. Topology structure of dual-motor-driven tracked vehicle.
Figure 11. Topology structure of dual-motor-driven tracked vehicle.
Wevj 15 00239 g011
Figure 12. The experimental platform and visualization results.
Figure 12. The experimental platform and visualization results.
Wevj 15 00239 g012
Figure 13. Schematic diagram of leader-following under actual vehicle experiment.
Figure 13. Schematic diagram of leader-following under actual vehicle experiment.
Wevj 15 00239 g013
Figure 14. Performance in actual vehicle experiments.
Figure 14. Performance in actual vehicle experiments.
Wevj 15 00239 g014
Table 1. Simulation model parameters.
Table 1. Simulation model parameters.
Vehicle Parameters
Weight/kg8000
Track contact length/m2.12
Driving wheel radius/m0.26
Center track distance/m1.78
Moment of inertia/kg·m21000
Gear ratio9.83
Table 2. Platform parameters.
Table 2. Platform parameters.
Vehicle Parameters
Weight/kg8000
Track contact length/m2.12
Driving wheel radius/m0.26
Center track distance/m1.78
Gear ratio9.83
Motor Parameters
Rated voltage/V550
Rated rotational speed/rpm1500
Peak rotational speed/rpm4500
Rated torque/Nm525
Peak torque/Nm900
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Fan, J.; Yan, P.; Li, R.; Liu, Y.; Wang, F.; Liu, Y.; Chen, C. Decoupled Adaptive Motion Control for Unmanned Tracked Vehicles in the Leader-Following Task. World Electr. Veh. J. 2024, 15, 239. https://doi.org/10.3390/wevj15060239

AMA Style

Fan J, Yan P, Li R, Liu Y, Wang F, Liu Y, Chen C. Decoupled Adaptive Motion Control for Unmanned Tracked Vehicles in the Leader-Following Task. World Electric Vehicle Journal. 2024; 15(6):239. https://doi.org/10.3390/wevj15060239

Chicago/Turabian Style

Fan, Jingjing, Pengxiang Yan, Ren Li, Yi Liu, Falong Wang, Yingzhe Liu, and Chang Chen. 2024. "Decoupled Adaptive Motion Control for Unmanned Tracked Vehicles in the Leader-Following Task" World Electric Vehicle Journal 15, no. 6: 239. https://doi.org/10.3390/wevj15060239

Article Metrics

Back to TopTop