Abstract
With the advancements in autonomous driving technology, artificial intelligence and computer science have facilitated the autonomous operation of machinery. Industrial production efficiency is enhanced by this autonomy in construction machinery. Furthermore, personal safety for machine operators is also improved. Among these advancements, path tracking control emerges as a critical component for the automation of construction machinery. It primarily focuses on the lateral and longitudinal control of the machinery, enabling stable tracking of a predefined path even under challenging operational conditions. To enhance the accuracy and robustness of path tracking, this paper proposes a mixed linear quadratic regulator (LQR) controller specifically designed for autonomous tracked vehicles. This approach uses the LQR control algorithm to suppress the noise generated by complex construction environments and accurately track the desired path. The effectiveness and practicality of this method are validated through simulation experiments.
You have full access to this open access chapter, Download conference paper PDF
Keywords
1 Introduction
Tracked vehicles are regarded as commonly ground unmanned mobile platforms in the domain of off-road strategies owing to their excellent traversability and maneuverability, to enhance navigation proficiency across diverse terrains. These scenarios encompass snow-covered terrains, unconsolidated sandy substrates, adhesive mud matrices, steep gradients, terrain laden with rubble, as well as intricate amalgamation thereof [1]. Nowadays, tracked vehicles are used in various industries, such as agriculture and military. Therefore, the study of automatic navigation and operation of tracked vehicles becomes imperative. As a pivotal technology in the realm of autonomous driving, trajectory tracking control also serves as a prerequisite for unmanned tracked vehicles to carry out missions effectively [2].
In previous studies, different strategies for vehicle trajectory tracking control have been proposed in the literature to achieve high-precision tracking, such as geometric and kinematic controllers, model based controllers, adaptive and intelligent controllers, and so on [3].
Initially, pure pursuit represents one of the foremost geometric controllers extensively employed by researchers [4]. It’s important to note that while geometric controllers offer these advantages, they may also have limitations, such as challenges in handling complex maneuvers or uncertainties in certain scenarios [4].
Model predictive control (MPC) serves as a technique capable of addressing system constraints and future projections. MPC aims to minimize tracking errors by utilizing a vehicle dynamics model to forecast the forthcoming vehicle nalysed within a defined prediction horizon [3]. Tang et al. [6] amalgamated model-based and data-driven control techniques, introducing a novel approach for trajectory tracking control in bidirectional independent electric-driven unmanned tracked vehicles. Model-based controllers also have limitations, including the need for accurate models, potential sensitivity to nalysed errors, and increased complexity in model development and maintenance.
Adaptive and intelligent controllers are typically employed in research or applications that demand a high degree of robustness against disturbances and variations. The fuzzy control rules of the agricultural machinery path tracking method utilizing the fuzzy adaptive pure pursuit model proposed by Li et al. [6] are established based on expert experiential knowledge, resulting in notable tracking errors that pose challenges for expeditious rectification. However, these controllers’ successful implementation requires proper design, training, validation, and consideration of potential limitations and challenges [8, 9].
In this paper, a trajectory tracking control method for unmanned tracked vehicles is proposed. The remainder of the paper is organized as follows. The kinematics analysis and nalysed of the tracked vehicle are carried out, and the expression of the controller is presented in Sect. 2. To demonstrate the performance of the proposed controller in path tracking, nalysed, and simulation experiments are carried out in Sect. 3, and the experimental results are nalysed. Finally, conclusions are given in Sect. 4.
2 Problem Description
In this paper, the trajectory tracking control of unmanned tracked vehicles is studied. For the subsequent construction of a path following controller and experimental verification, kinematic modeling is used in this paper, not only because it provides a simplified and accurate representation of vehicle motion, especially in cases where the primary concern is a path following and position accuracy rather than complex mechanical interactions, but also because it improves computational efficiency and allows for real-time implementation of control algorithms.
2.1 Modeling Premises and Assumptions
This section undertakes a kinematic analysis of tracked vehicles. To facilitate the analysis of tracked vehicle kinematics, specific assumptions are necessary regarding the research subject. Throughout the motion process, this study makes the following assumptions [10].
-
(1)
The contact surfaces of the tracks on both sides of the tracked vehicle are even, ensuring uniform contact with the ground, and frictional forces are uniform in magnitude across all points.
-
(2)
The resistance coefficient remains consistent between steering and straight-line travel.
-
(3)
The lengths of the tracks in contact with the ground on both sides are equal, and variations in track tension are not taken into consideration for their impact on ground pressure.
-
(4)
The contribution of aerodynamic resistance for the tracked vehicle can be disregarded.
2.2 Kinematic Analysis of Tracked Vehicles
It is imperative to establish a suitable coordinate system that accurately describes the motion state, pose information, and relative position details of the tracked vehicle to successfully carry out tasks such as path planning, obstacle avoidance, and tracking. This paper introduces a tracked vehicle kinematic model based on the instantaneous center of rotation, as depicted in Fig. 1.
Tracked vehicles commonly involve two types of coordinate systems: the absolute coordinate system \(F(XOY)\) and the body coordinate system \(f(xoy)\). In Fig. 1, \({\text{ICC}}\) represents the instantaneous rotation center of the tracked vehicle, \(R\) represents the instantaneous rotational motion radius, \(l\) is the center distance of both tracks, \(\omega \) represents the lateral angular velocity of the vehicle, \(\overrightarrow{v}\) is the instantaneous velocity vector, \(\theta \) is the heading angle and \(\alpha \) represents the angle between the velocity vector and the X-axis, the side-slip angle. \((X,Y,\theta )\) is the pose information of the tracked vehicle in the absolute coordinate system; \((\dot{X},\dot{Y},\dot{\theta })\) is the linear velocity and rotational angular velocity of the tracked vehicle in the \({\text{X}}\) and \({\text{Y}}\) axis directions in the absolute coordinate system.
Under conditions of low-speed motion, the slip motion and slip angle of tracked vehicles are disregarded. Based on Fig. 1, formula (1) can be derived [3].
In tracked vehicles, the forward velocity of the vehicle's center point is equal to the average speeds of the left and right tracks:
When the time increment is very small and the change in the vehicle's rotation angle is minimal, the approximate formula is as follows:
where, \({{\text{v}}}_{{\text{l}}}\) and \({{\text{v}}}_{{\text{r}}}\) represent the speed of the left and right track, respectively.
From Eq. (3), the angular velocity of the tracked vehicle's motion around the center of rotation \(\upomega \) can be obtained, which is also the rate of change in the heading angle.
The curved motion radius of the tracked vehicle can be derived from Eqs. (2) and (4).
The relationship between the left and right wheel speeds of the tracked vehicle, the center point linear velocity, and the angular velocity can be obtained from Eqs. (2), (4), and (5) as follows.
2.3 Pose Error Model for Tracked Vehicles
Tracking error is one of the most commonly used quantitative measures for assessing the effectiveness of a controller. It is typically characterized as the difference between the desired path and the actual vehicle position [3, 11]. The parameters for tracking error, as depicted in Fig. 2, are illustrated.
Equation (7) is one of the commonly used formulas for determining tracking error, encompassing longitudinal, lateral, and heading errors.
The differential equations for the pose error can be obtained from Eqs. (6) and (7).
2.4 Controller Design
In this section, the proposed LQR controller is introduced in detail. By employing Eq. (9) as the differential equation for pose error, with lateral error and heading error as state variables, and rotational angular velocity as input, a linearized equation can be derived:
where, \(x(t)=\left[\begin{array}{c}{e}_{{\text{y}}}\\ {e}_{\uptheta }\end{array}\right]\), \(\dot{x(t)}=\left[\begin{array}{c}\dot{{e}_{{\text{y}}}}\\ \dot{{e}_{\uptheta }}\end{array}\right]\), \(u=\omega \), \(A=\left[\begin{array}{cc}0& {v}_{{\text{ref}}}\\ 0& 0\end{array}\right]\), \(B=\left[\begin{array}{c}-l\\ -1\end{array}\right]\)
3 Illustrative Examples
In this section, the proposed LQR controller is applied to a tracked vehicle simulation model to demonstrate its effectiveness and practicality as shown in Fig. 3. The simulation environment is MATLAB R2022b. The simulation results are shown in Figs. 4–7.
Figure 4 presents a comparison of steering trajectories, illustrating the actual path followed by the tracked vehicle when different controllers are employed under the reference path. It can be observed that when the traditional PID controller is used, there is a certain amount of overshoot after the straight-line travel phase ends. Moreover, during sharp turns, the traditional PID controller struggles to accurately track the curvature, resulting in noticeable errors. In contrast, the LQR controller demonstrates improved steering performance, particularly when entering turns. Figure 5 presents the overall trajectory map used in the simulation experiments, illustrating the performance of different control algorithms throughout the complex route.
In Fig. 6, the actual vehicle motion under control signals is depicted, where “krz” represents the discrete input for the speed ratio. Compared to the output signal under PID control, the LQR control signal achieves superior control performance with a smaller overshoot and shorter settling time. Notably, the settling time is reduced by 5 s, and the overshoot is diminished to one-third. Furthermore, from the tracked vehicle’s Y-coordinate data, it is evident that LQR initially exhibits a slight deviation but subsequently achieves stability more rapidly through angle adjustments.
Figure 7 displays a comparison of tracking performance, demonstrating the control signals generated by the controllers under different error inputs. While the PID control system exhibits faster error reaching its peak value, it experiences a longer overall settling time and shorter oscillation periods. In contrast, the LQR control allows the error to reach zero within a shorter time frame of 15 s. Additionally, regarding the control signal for angular velocity output, LQR results in a smaller overshoot. This enables the tracked vehicle system to achieve the desired pose more rapidly when the tracking path undergoes sudden changes.
4 Conclusion
This paper establishes a tracked vehicle kinematic model based on the instantaneous center of rotation. A path tracking controller using a Linear Quadratic Regulator is designed, which simultaneously takes into account vehicle tracking accuracy and reduces the demand for model precision.
Through an analysis of the results obtained from MATLAB simulation experiments, it is observed that the approach presented in this paper achieves higher path tracking accuracy compared to traditional control methods. Under the same driving trajectory, notably improved steering performance is attained during corner entry. Overshoot is significantly reduced, the settling time is shortened, and steady-state error is eliminated.
References
Chen H, Zhang Y (2014) An overview of research on military unmanned ground vehicles. J Binggong Xuebao/Acta Armamentarii 35:1696–1706. https://doi.org/10.3969/j.issn.1000-1093.2014.10.026
Al-Jarrah A, Salah M, Almomani F (2019) Controlling a Skid-Steered tracked mobile robot with slippage using various control schemes. In: 2019 20th International Conference on Research and Education in Mechatronics (REM). https://doi.org/10.1109/REM.2019.8744123.
Noor H, Hairi Z, Khisbullah H (2017) Modeling and control strategies in path tracking control for autonomous ground vehicles: a review of state of the art and challenges. J J Intell and Robot Syst, 86(2):1–30.https://doi.org/10.1007/s10846-016-0442-0
Zhou X, Yu X, Zhang Y, Luo Y (2021) Trajectory planning and tracking strategy applied to an unmanned ground vehicle in the presence of obstacles. IEEE Trans Autom Sci Eng (99): pp 1–15. https://doi.org/10.1109/TASE.2020.3010887
Meng Y, Gan X, Bai G (2019) Path tracking control of mobile robot based on the motion compensation method. In: 2019 Chinese Control And Decision Conference (CCDC). Nanchang. pp 2520–2525. https://doi.org/10.1109/CCDC.2019.8833451
Tang Z, LIU H, Xue M, (2023) Trajectory tracking control of electrically driven unmanned Vehicle based on MSC-MFAC. J Acta Ordnance Eng 44(1):129–139
Li E, Hu J, Gao L (2013) Pure tracking model of agricultural machinery based on fuzzy adaptive path following method. J J Agric Mach 44(1):6. https://doi.org/10.6041/j.iSSN.1000-1298,2013.01.039
Li Y, Yu J, Guo X, Sun J (2020) Path tracking method of unmanned agricultural vehicle based on compound fuzzy control. In: 2020 IEEE 9th Joint International Information Technology and Artificial Intelligence Conference (ITAIC). https://doi.org/10.1109/ITAIC49862.2020.9338981.
Li R, Xiang CL, Wang C (2021) Robust adaptive trajectory tracking control method for autonomous tracked vehicle. J. Acta Armamentarii 42(6):1128–1137
Rui Q, Wang H, Wang Q (2015) Based on the analysis of the shear stress model of tracked vehicle steering torque and test. J J These 36(6):968–977. https://doi.org/10.3969/j.iSSN.1000-1093,2015.06.002
Wang L, Chen ZL, Zhu W (2022) An improved pure pursuit path tracking control method based on heading error rate. J Ind Robot 5:49
Acknowledgements
Key projects of natural science foundation of Fujian Province (2021J02013), Xiamen Major Science and Technology Plan Projects: 3502Z20231013
Fujian University industry university research joint innovation project plan (2022H6007)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Open Access This chapter is licensed under the terms of the Creative Commons Attribution 4.0 International License (http://creativecommons.org/licenses/by/4.0/), which permits use, sharing, adaptation, distribution and reproduction in any medium or format, as long as you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons license and indicate if changes were made.
The images or other third party material in this chapter are included in the chapter's Creative Commons license, unless indicated otherwise in a credit line to the material. If material is not included in the chapter's Creative Commons license and your intended use is not permitted by statutory regulation or exceeds the permitted use, you will need to obtain permission directly from the copyright holder.
Copyright information
© 2024 The Author(s)
About this paper
Cite this paper
Tian, B., Lin, T., Zhang, C., Li, Z., Fu, S., Chen, Q. (2024). Mixed Linear Quadratic Regulator Controller Design for Path Tracking Control of Autonomous Tracked Vehicles. In: Halgamuge, S.K., Zhang, H., Zhao, D., Bian, Y. (eds) The 8th International Conference on Advances in Construction Machinery and Vehicle Engineering. ICACMVE 2023. Lecture Notes in Mechanical Engineering. Springer, Singapore. https://doi.org/10.1007/978-981-97-1876-4_10
Download citation
DOI: https://doi.org/10.1007/978-981-97-1876-4_10
Published:
Publisher Name: Springer, Singapore
Print ISBN: 978-981-97-1875-7
Online ISBN: 978-981-97-1876-4
eBook Packages: EngineeringEngineering (R0)