Next Article in Journal
Evaluating Structural Details’ Influence on Elastic Wave Propagation for Composite Structures via Ray Tracing
Previous Article in Journal
Correction: Bohlke et al. The Effect of a Verbal Cognitive Task on Postural Sway Does Not Persist When the Task Is Over. Sensors 2021, 21, 8428
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Research on Accurate Motion Trajectory Control Method of Four-Wheel Steering AGV Based on Stanley-PID Control

1
School of Mechatronic Engineering and Automation, Foshan University, Foshan 528001, China
2
School of Mechatronic Engineering, Changchun University of Science and Technology, Changchun 130022, China
3
Ministry of Education Key Laboratory for Cross-Scale Micro and Nano Manufacturing, Changchun 130022, China
*
Author to whom correspondence should be addressed.
Sensors 2023, 23(16), 7219; https://doi.org/10.3390/s23167219
Submission received: 20 July 2023 / Revised: 5 August 2023 / Accepted: 15 August 2023 / Published: 17 August 2023
(This article belongs to the Section Vehicular Sensing)

Abstract

:
With the continuous progress and application of robotics technology, the importance of mobile robots capable of adapting to specialized work environments is gaining prominence. Among them, achieving precise and stable control of AGVs (Automated Guided Vehicles) stands as a paramount task propelling the advancement of mobile robotics. Consequently, this study devises a control system that enables AGVs to attain stable and accurate motion through equipment connection and debugging, kinematic modeling of the four-wheel steering AGV, and a selection and comparative analysis of motion control algorithms. The effectiveness of the Stanley-PID control algorithm in guiding the motion of a four-wheel steering AGV is validated through MATLAB 2021a simulation software. The simulation results illustrate the outstanding stability and precise control capabilities of the Stanley-PID algorithm.

1. Introduction

With the emerging market of advanced Autonomous Ground Vehicles (AGVs) and mobile robots, the development of vehicle lateral and longitudinal control technology has become an important research topic. Research on AGVs primarily involves planning decisions, motion control, and environmental awareness, with motion control being the fundamental and crucial task for achieving precise AGV motion [1,2]. AGV motion control encompasses two key aspects: longitudinal control and lateral control [3,4,5,6]. Longitudinal control focuses on precise velocity control during AGV motion and employs methods such as PID control [1], model predictive control [2], and adaptive control [7]. PID control utilizes feedback information on velocity differences to adjust a vehicle’s acceleration, ensuring smooth, stable, and efficient motion. Lateral control involves correct path following and deviation correction, with approaches including Pure Pursuit control [8], LQR control [9], and Stanley control [10]. The Stanley control algorithm maintains the vehicle on the centerline by correcting forward errors, facilitating proper path tracking and deviation correction. For the motion control of a four-wheel steering AGV, the Stanley-PID algorithm integrates longitudinal and lateral control, optimizing control performance and achieving precise vehicle motion control while ensuring stability and reliability. By combining longitudinal control, lateral control, and optimization methods, the accuracy and reliability of AGV motion can be significantly improved.
Experts and scholars both domestically and internationally have conducted research on the motion trajectory control of Autonomous Ground Vehicles (AGVs), proposing adaptive control and fuzzy control methods [11,12,13]. However, adaptive control is prone to operational errors when sensors malfunction or behave abnormally, while fuzzy control rules cannot be adjusted online once determined, limiting their adaptability to changing situations [14]. Current research mainly focuses on nonlinear methods such as the theory of variable structure systems and fuzzy control for AGV motion control, particularly in the context of PID longitudinal control [15,16]. The complex composition and kinematic model of a four-wheel steering AGV can lead to inconsistencies in drive motor speeds during control, resulting in interference between motion units and issues such as vehicle swing or rollover [10]. The Stanley algorithm is suitable for guiding vehicles along pre-planned paths, but it may deviate from the original path when encountering deviations or unpredictable circumstances [15,17,18,19,20,21]. On the other hand, PID algorithms assist vehicles in making real-time adjustments, enabling them to maintain stability in various environments and conditions [15,16,18,22]. Based on the literature [1,2,7,9,11,12,13,14,15,16,18,21,22,23,24], it is evident that PID control algorithms are primarily applied in linear systems, while AGV motion control systems are nonlinear. PID algorithms mainly involve cumulative error calculations, making them susceptible to saturation. The Stanley algorithm focuses on lateral control and needs to be combined with other lateral control algorithms to achieve comprehensive motion control. Therefore, the Stanley-PID algorithm adjusts AGV vehicle speed and steering angle in real time by calculating error vectors and path deviations, ensuring that the AGV moves along a reasonable trajectory and accurately tracks the desired route, guaranteeing stability and precision.
This study aims to achieve precise motion control of a four-wheel steering AGV by combining longitudinal and lateral control methods, providing an innovative solution for AGV motion control and overcoming limitations of traditional control methods. By integrating longitudinal control, lateral control, and optimization techniques, the motion performance of AGVs in complex environments is improved. This paper conducts simulation analysis on the kinematic model of a four-wheel steering AGV and proposes a simulation experiment using the Stanley-PID algorithm for AGV motion control. A comparison is made with a single PID algorithm and the Stanley algorithm, demonstrating the effectiveness and feasibility of the Stanley-PID algorithm. By considering both longitudinal and lateral control and employing optimization methods, this research offers an innovative solution for AGV motion control, overcoming the limitations of traditional control methods, and enhancing the motion performance of AGVs in complex environments. The experimental results indicate the significant advantages of the Stanley-PID algorithm in achieving precise motion control, providing a viable solution for the practical application of AGVs.

2. Structure of the Motion Control System

The 4WS AGV platform consists of a motion chassis, four steering wheel mechanisms, and four lifting mechanisms. The motion chassis is used to install the motion controller, batteries, servo drivers, and sensors, among other components. The structure of the motion control system for the AGV is illustrated in Figure 1. To achieve real-time coordinated control of the 12 servo motors, a CAN (Controller Area Network) bus is employed for communication between the controller and the drivers.
The four driving servo drivers and four lifting servo drivers utilize feedback signals from Hall sensors and incremental encoders mounted on the servo motors to achieve precise speed closed-loop control. In addition to monitoring the speed feedback signals, the four steering servo drivers also measure the rotation angle of the steering motors, enabling accurate position closed-loop control.

3. Kinematic Modeling

The AGV belongs to the category of nonholonomic motion systems. Unlike holonomic kinematics models, the nonholonomic kinematics model considers the effects of both dynamic and kinematic constraints on the motion state. The following assumptions are made [25,26]:
  • The AGV is treated as a rigid body.
  • The steering motors of each steering wheel are perpendicular to the ground, while the driving motors are parallel to the ground.
  • The steering wheels only experience pure rolling without any relative sliding.
From a control perspective, there are three controlled variables for the steering wheels: v (appropriate velocity), θ (current steering angle of the steering wheel as a whole), and ω (rotational angular velocity). The absolute coordinate system (X0, Y0, Z0) and the relative coordinate system (XOI, YOI, ZOI) are defined, where the geometric center of the 4WS AGV vehicle coincides with the origin of the relative coordinate system. The Y1-axis represents the lateral direction, and the X1-axis represents the longitudinal direction. The angle θ represents the orientation between the absolute and relative coordinate systems. The main motion parameters of the AGV are summarized in Table 1.
In order to simplify the complexity of the inverse kinematics, the AGV vehicle is selected to perform a curved motion around a point in the relative coordinate system. The motion is illustrated in Figure 2. The angle between the velocity direction at the centroid of the AGV and YI is denoted as θI = arctan(b/a), while the angle between the velocity direction at the centroid and Y0I is denoted as θ0 = θI + θ. The steering angles of the four wheels are represented as α = β = η = γ, and the velocity relationship is denoted as V1 = V2 = V3 = V4. Based on the geometric kinematics model [16], the pose of the AGV centroid in the absolute coordinate system can be represented as X ˙ = x ˙ y ˙ φ ˙ T .
Based on Figure 2b:
a = sin α cos β x 1 cos α sin β x 2 cos α cos β y 1 y 2 sin α β b = sin α cos β x 1 x 2 cos α sin β y 2 cos α cos β y 2 sin α β
The radius from each steering wheel to the center of rotation OI can be expressed as:
R i = y i b 2 a x i 2 R = a 2 b 2         i = 1,2 , 3,4
The angular velocity at the rotation center OI is ω = Vi/Ri, and the velocity direction of the AGV in the absolute coordinate system is θ0 = θI + θ. Here, | x 1 | = | x 2 | = | x 3 | = | x 4 | = D / 2 , | y 1 | = | y 2 | = | y 3 | = | y 4 | = L / 2 , and the rotation angle of each steering wheel can be calculated as [16]:
α = tan 1 y 1 b / x 1 a β = tan 1 y 2 b / x 2 a η = tan 1 y 3 + b / x 3 a γ = tan 1 y 4 + b / x 4 a
In Equations (1)–(3), the parameters (driving speed and rotation angle) of each steering wheel can be solved, and the AGV can walk and turn according to the target trajectory [15,16,22,24].
By performing a MATLAB 2021a software simulation with a specified size of 7000 mm × 3590 mm × 531 mm for the 4WS AGV and a moving speed of VI = 0.05 m/s, the inverse kinematics are used to calculate the velocities and angles of the four steering wheels. The results are presented in Table 2.
The forward kinematics model of the AGV vehicle determines the velocities and angles of each steering wheel. The inverse kinematics simulation results are used as inputs to validate the forward kinematics simulation parameters, as shown in Figure 3.
The AGV vehicle follows a circular path with (0, 0) as the center, as shown in Figure 3c. Within 60 s, the AGV vehicle exhibits sinusoidal and cosine variations along the X and Y axes, respectively, ranging between (−1, 1) and (−2, 0). After performing simulation calculations, a rotational radius of 1 m and a linear velocity of 0.1 m/s are obtained. The simulation, combining both forward and inverse kinematics models, mutually verifies their correctness.

4. Motion Trajectory Control Analysis

The AGV vehicle is a nonholonomic and nonlinear system, which requires an appropriate control method. The PID algorithm has the advantages of simple structure and easy implementation, but it can only work under linear conditions, leading to reduced control accuracy. The Stanley-PID control combines the advantages of the Stanley algorithm and the PID controller. It uses the Stanley algorithm to calculate the lateral error and feeds it into the PID controller to generate longitudinal commands. This approach can better adapt to dynamic characteristics and disturbances, resulting in more precise path-tracking control. By combining it with the trial-and-error method for tuning PID parameters, further improvement in control accuracy can be achieved. Table 3 illustrates the advantages and disadvantages of various controllers [27].

4.1. Stanley Control

The Stanley algorithm is a control method that takes into account the lateral error (e) between the AGV and the desired motion trajectory. It aims to minimize the lateral error and also considers the heading deviation (θe) between the AGV’s orientation and the desired path. By utilizing the geometric relationship between the vehicle and the road during motion, the Stanley algorithm obtains the necessary variables for controlling the AGV’s movement, as shown in Figure 4 [14,15,21,35,36].
Based on the relative geometric relationship between the AGV’s motion pose and the given path, the control variables for controlling the AGV’s steering angle can be directly obtained. With the lateral error (e) and heading error (θe), the steering angle for the steering wheels can be determined.
δ t = θ e t + δ e t
The rate of change of lateral error is denoted as:
e ˙ t = V t sin δ e t
When θe = δe, the AGV turns based on the heading error angle θe to track the desired trajectory. Without considering the heading error angle θe, assuming that the expected trajectory of the AGV intersects with the nearest tangent to the given path at a distance of d(t) from the steering wheel, the non-linearity proportional function can be derived based on the AGV’s motion geometry [20].
δ e t = arctan e t d t = arctan k e t d t
where d(t) = V(t)/k and k are control gain parameters, and d(t) is the forward distance of the steering wheel, which is proportional to the speed of the steering wheel. Taking into account the two scenarios mentioned above, the basic steering angle control equation can be represented as follows:
δ t = θ e t + arctan k e t / V t
According to Figure 4, sinδe(t) can be expressed as:
sin δ e t = e t d t 2 + e t 2 = k e t V t 2 + k e t 2
As shown in Equations (4)–(8), it can be derived that the rate of change of lateral error, e(t), is [15]:
e ˙ t = k e t 1 + k e t V t e
In Equations (7) and (9), it can be observed that when the lateral deviation (e) is small or nonexistent, δ(t) = θe(t); and when the heading angle (θe) deviation is small or nonexistent, e ˙ t k e ( t ) ; the heading angle control equation can be expressed as:
δ t = arctan k e t / V t
Equation (10) is solved by applying the Laplace transform to the differential equation, resulting in:
e ˙ = e 0 × e k t
Therefore, the lateral error converges exponentially to e(t) = 0, where the parameter k determines the convergence rate. For any lateral error, the differential equation monotonically converges to 0.
The Stanley algorithm is a control strategy based on path tracking and local perception to achieve high-precision vehicle motion control. However, the Stanley algorithm is primarily suitable for vehicles driving on smooth road surfaces and has limitations when it comes to controlling AGVs that consider nonholonomic constraints and dynamic characteristics. The Stanley algorithm requires accurate initial position and orientation information as well as a smooth path. In complex trajectories and environments, the Stanley algorithm may fail. In areas such as tunnels and basements, the sensors may not provide reliable data.

4.2. PID Control

PID control is essentially a control strategy where the proportional coefficient reflects the current state of the input signal, the integral signal represents the cumulative changes of the signal, and the derivative signal indicates the trend of the input signal’s changes, as shown in Figure 5 [11,20].
Where r(t) represents the input of the control system, u(t) represents the output of the control system, y(t) represents the current value of the controlled object, and e(t) represents the error between the current system input r(t) and the desired output y(t). By calculating the deviation between the desired r(t) and the current output y(t), and integrating the proportional (P), integral (I), and derivative (D) components, the closed-loop control output is obtained to adjust the output of the controlled object. The PID control adopts the typical PID incremental control, and its expression is as follows:
u k = u k 1 + K P e k e k 1 + K I e k + K D e k 2 e k 1 + e k 2
e t = r t y t
In the equation, KP represents the proportional coefficient, KI (KI = KP/TI) represents the integral coefficient, and KD (KD = KPTD) represents the derivative coefficient.
In the motion trajectory control analysis of a 4WS AGV vehicle, the main reason for not directly using the Stanley algorithm is that its handling of the contour line is not suitable for AGV vehicles, which belong to a special type of nonholonomic kinematics systems. Therefore, in practical applications, it is common to combine other control algorithms and techniques to achieve more stable and reliable AGV motion trajectory control.

4.3. Parameter Tuning

Ref. [19] shows how Snider implemented the Stanley controller in Equation (7) and compared its performance in different motion environments.
The trial-and-error method [17] is a process of simulating or physically operating a closed-loop system, observing the system response curve, and repeatedly adjusting the parameters based on the approximate impact of each tuning parameter on the system response. This process is conducted to achieve a satisfactory response and determine the three tuning parameters in the PID control. MATLAB Simulink functionality is utilized to tune the PID parameters, as shown in Figure 6.
During the motion trajectory control of AGV, the main role of the PID algorithm is to calculate the control signal that enables the AGV to follow the expected trajectory. The trial-and-error method helps find suitable PID algorithm parameters to achieve more accurate and stable control. In practical applications, different control systems, control objects, and control requirements may lead to different choices of PID parameters.

4.4. Stanley-PID Control

The motion trajectory control of a four-wheel steering AGV (4WS AGV) belongs to a complex system. The combination of PID and Stanley control allows for the adjustment of both the longitudinal and lateral deviations. The control principle is illustrated in Figure 7.
According to Equation (13), the path deviation under Stanley-PID control is denoted as e(t) = r(t) − y(t). According to Equations (7) and (12), the steering wheel rotation angle U(t) under Stanley-PID control can be calculated as:
U t = δ s t a n l e y + K P e k e k 1 + K I e k + K D e k 2 e k 1 + e k 2
In conclusion, selecting the appropriate control algorithm is crucial in analyzing AGV motion trajectory control. For applications requiring high precision control, the Stanley-PID control algorithm is worth considering as a preferred method due to its adaptability to complex road conditions.

4.5. Simulation Results Analysis

In the simulation setup, the AGV’s initial coordinates are (0, 0), with a velocity of 0 and a heading angle of 0. The sampling time is T = 60 s, the scan period is ts = 0.005 s, and the interval time is dt = 0.1 s. The desired value r is set to 1, and the simulation is performed using Stanley, PID, and Stanley-PID control methods.
For Stanley control, the motion velocities are set to 3 m/s, 2 m/s, 1 m/s, 0.5 m/s, and 0.3 m/s, with a control gain of 1 for the simulation.
The simulation results are shown in Figure 8. As the velocity increases under Stanley control, the AGV exhibits deviation, and the deviation becomes larger with higher velocities. On the other hand, as the velocity decreases, the vehicle experiences shaking.
In PID control, based on the existing forward and inverse kinematics models, and using the trial-and-error method, the following parameters are obtained: KP = 0.22, KI = 0.13, KD = 0.
When the initial position deviation of the AGV is the same, the deviation under PID control decreases rapidly. However, under PID control, there are 3 to 4 fluctuations in the motion trajectory, and the AGV vehicle converges to the desired trajectory after approximately 6 s, as shown in Figure 9.
Figure 10 represents the simulation analysis of Stanley-PID motion trajectory control. The initial state of the AGV vehicle is set as (0, 0, 0), and the desired running speed is 8 m/s. The lateral deviation is calculated using MATLAB 2021a software.
Figure 10 presents the simulated results of the fitted sinusoidal trajectory and rotation angle. The positive values (1.361) represent left steering wheel output, while the negative values (−0.648, −1.253) represent right steering wheel output. By combining the simulation results from Figure 8 and Figure 9, along with the error curve in Figure 11, it can be observed that under PID control, there is initially a fluctuation in position deviation, which is approximately 0.04. In comparison, Stanley-PID control exhibits smaller motion trajectory fluctuations and a more stable response.
Based on the comparison of the simulation results mentioned above, in the motion trajectory control of the AGV, Stanley-PID control exhibits faster response, smaller fluctuations, and smoother variations compared to a single PID control. This demonstrates stronger system stability.

5. Discussion

This study primarily focuses on equipment connection and debugging, kinematic modeling, as well as a comparative analysis of motion control algorithms for the four-wheel steering AGV (Automated Guided Vehicle). Firstly, we meticulously conduct equipment connection and debugging for the four-wheel steering AGV to ensure seamless communication and data transmission between the controller, driver, and steering devices. This crucial step lays a solid foundation for subsequent experiments and simulations. Secondly, a comprehensive kinematic model of the four-wheel steering AGV is established, thoroughly analyzing its motion characteristics and key parameters for precise modeling. This serves as the cornerstone for the design of control algorithms and motion simulations. Subsequently, our study delves into the selection of suitable control algorithms. We thoroughly compare the performance of the Stanley-PID algorithm, traditional PID algorithm, and Stanley algorithm in path-tracking tasks. The innovative Stanley-PID algorithm, which ingeniously combines the strengths of Stanley and PID controllers, calculates lateral errors using the Stanley algorithm and inputs them into the PID controller to generate longitudinal commands, resulting in unparalleled accuracy for path tracking control. Lastly, we thoughtfully summarize the aforementioned findings, extensively discuss factors impacting the motion control precision of the four-wheel steering AGV, and propose effective solutions to address these challenges. Our research endeavors to elevate the motion precision of the four-wheel steering AGV, offering robust and precise motion control solutions for practical applications. However, one limitation of this study lies in the lack of experimental validation. As a specialized mobile robot platform with distinct advantages, conducting experimental tests on the four-wheel steering AGV is essential for evaluating its overall performance. Through these experiments, comprehensive assessments can be made regarding its navigation accuracy, stability, energy consumption, and other performance indicators, while also facilitating comparisons with other types of AGVs. Without such experiments, the potential strengths and limitations of the research work may not be fully understood and demonstrated. Conducting experiments on the four-wheel steering AGV will allow for a better exploration and confirmation of these advantages, providing further references and directions for future research improvements.

6. Conclusions

In this study, we established the motion model of a four-wheel-steering AGV (4WS AGV) and introduced the principles of Stanley-PID control. Simulation analysis was conducted using MATLAB software. The results of the simulation experiments demonstrated that the Stanley-PID algorithm outperforms traditional PID algorithms, particularly in terms of tracking accuracy and steady-state error. In the analysis of motion trajectory control for the 4WS AGV, the Stanley-PID algorithm exhibited a response time of around 0.2, with the path error initially fluctuating between 0 and −1.5 and eventually stabilizing at around 0.4. On the other hand, the single PID algorithm had a response time of around 0.3, with the path error fluctuating between 0 and −1.6, thus confirming its effectiveness and feasibility. In the motion trajectory control of the 4WS AGV, the Stanley-PID control demonstrated advantages such as faster response, smaller fluctuations, smoother variations, and stronger system stability compared to single PID control.
Regarding the future development directions for the motion trajectory control of four-wheel steering AGVs, there are several aspects that deserve our attention:
(1)
Conducting four-wheel steering AGV experiments: To comprehensively assess the navigation and maneuvering performance of four-wheel steering AGVs, conducting a series of experiments to validate their capabilities is recommended. These experiments can be designed to test the behavior and performance of four-wheel steering AGVs in various scenarios and tasks.
(2)
Exploring path planning algorithms for four-wheel steering AGVs: Leveraging the maneuverability of four-wheel steering AGVs, further exploration and research on new path planning algorithms and optimization methods are worthwhile.
(3)
Exploring diverse application areas for four-wheel steering AGVs: Apart from traditional material handling and warehousing, consider applying four-wheel steering AGVs in indoor navigation, smart warehousing, automated logistics, and service robotics. Expanding the range of application areas will provide insights into the potential and prospects of four-wheel steering AGVs.
(4)
Technology integration: Integrating four-wheel steering AGVs with other technologies, such as sensor fusion, can achieve more precise environmental perception and autonomous navigation. Additionally, combining artificial intelligence, data analytics, and decision algorithms can enhance the intelligence level of four-wheel steering AGVs in complex environments.
(5)
Anomaly detection and robust control: With continuous technological advancements, the research of systems that would enable four-wheel steering AGVs to automatically detect and resolve faults is necessary. Designing robust motion trajectory control algorithms to maintain stable and reliable trajectory tracking capability under uncertainty and disturbances is also crucial.
(6)
Energy optimization: The Exploration of energy optimization methods for the motion trajectory control of four-wheel steering AGVs, aiming to prolong battery life, improve energy utilization efficiency, reduce dependence on charging devices, and achieve sustainable development with genuine energy-saving and emission reduction benefits is recommended.

Author Contributions

W.F.: conceptualization, methodology, investigation, writing. Y.L.: validation, formal analysis, visualization, software. X.Z.: validation, formal analysis, visualization, investigation. All authors have read and agreed to the published version of the manuscript.

Funding

This work was funded by the basic and applied basic research fund of Guang-dong province, grant number 2021A1515110927”, “Jilin Province Scientific and Technological Development Program, grant number 20200201006JC”, “The Open Project Program of Key Laboratory for Cross-Scale Micro and Nano Manufacturing, Ministry of Education, Changchun University of Science and Technology, grant number CMNM-KF202108”, “Scientific Research Project of Education Department of Guangdong Province, grant number 2022KCXTD029”.

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Anil, A.; Jisha, V.R. Trajectory Tracking Control of an Autonomous Vehicle using Model Predictive Control and PID Controller. In Proceedings of the 2023 International Conference on Control, Communication and Computing (ICCC), Thiruvananthapuram, India, 19–21 May 2023; pp. 1–6. [Google Scholar] [CrossRef]
  2. Xu, Q.; Ai, C.; Geng, D.; Ren, G.; Wang, Z. Research on Truck AGV Control System. In Proceedings of the 2020 IEEE 8th International Conference on Computer Science and Network Technology (ICCSNT), Dalian, China, 20–22 November 2020; pp. 176–180. [Google Scholar] [CrossRef]
  3. Moshayedi, A.J.; Li, J.; Sina, N.; Chen, X.; Liao, L.; Gheisari, M.; Xie, X. Simulation and Validation of Optimized PID Controller in AGV (Automated Guided Vehicles) Model Using PSO and BAS Algorithms. Comput. Intell. Neurosci. 2022, 2022, 7799654. [Google Scholar] [CrossRef] [PubMed]
  4. Qi, J.; Wu, Y. Trajectory Tracking Control for Double-steering Automated Guided Vehicle Based on Model Predictive Control. J. Phys. Conf. Ser. 2020, 1449, 012107. [Google Scholar] [CrossRef]
  5. Gong, H.; Fang, Q.; Li, G.Q.; Zheng, X.F.; Zhu, Y.R. Design of AGV motion control system based on model reference adaptive method. Zhejiang Daxue Xuebao (Gongxue Ban)/J. Zhejiang Univ. (Eng. Sci.) 2022, 56, 1867–1875. [Google Scholar] [CrossRef]
  6. Nawawi, S.W.; Abdeltawab, A.A.A.; Samsuria, N.E.N.; Sirkunan, N.A. Modelling, Simulation and Navigation of a Two-Wheel Mobile Robot using Pure Pursuit Controller. Elektr. J. Electr. Eng. 2022, 21, 69–75. [Google Scholar] [CrossRef]
  7. Hu, H.; Jia, X.; Liu, K.; Sun, B. Self-Adaptive Traffic Control Model With Behavior Trees and Reinforcement Learning for AGV in Industry 4.0. IEEE Trans. Ind. Inform. 2021, 17, 7968–7979. [Google Scholar] [CrossRef]
  8. Fukao, T.; Nakagawa, H.; Adachi, N. Adaptive tracking control of a nonholonomic mobile robot. IEEE Trans. Robot. Autom. 2000, 16, 609–615. [Google Scholar] [CrossRef]
  9. Moshayedi, A.J.; Roy, A.S.; Liao, L. PID Tuning Method on AGV (automated guided vehicle) Industrial Robot. J. Simul. Anal. Nov. Technol. Mech. Eng. 2019, 12, 53–66. [Google Scholar]
  10. Kodagoda, K.R.S.; Wijesoma, W.S.; Teoh, E.K. Fuzzy speed and steering control of an AGV. IEEE Trans. Control Syst. Technol. 2002, 10, 112–120. [Google Scholar] [CrossRef]
  11. Lee, G.D.; Kim, S.W.; Yim, Y.U.; Jung, J.H.; Oh, S.Y.; Kim, B.S. Longitudinal and lateral control system development for a platoon of vehicles. In Proceedings of the Proceedings 199 IEEE/IEEJ/JSAI International Conference on Intelligent Transportation Systems (Cat. No.99TH8383), Tokyo, Japan, 5–8 October 1999; pp. 605–610. [Google Scholar] [CrossRef]
  12. Hedrick, J.; McMahon, D.; Narendran, V.; Swaroop, D. Longitudinal Vehicle Controller Design for IVHS Systems. In Proceedings of the 1991 American Control Conference, Boston, MA, USA, 26–28 June 1991; pp. 3107–3112. [Google Scholar] [CrossRef]
  13. Rokonuzzaman, M.; Mohajer, N.; Nahavandi, S.; Mohamed, S. Review and performance evaluation of path tracking controllers of autonomous vehicles. IET Intell. Transp. Syst. 2021, 15, 646–670. [Google Scholar] [CrossRef]
  14. Wang, Z.; Li, Z.; Hua, Q.; Liu, D. Real-Time Adjustment of AGV Movement Trajectory by Utilizing PID Module of PLC. In Proceedings of the 2020 International Conference on Artificial Intelligence and Electromechanical Automation (AIEA), Tianjin, China, 26–28 June 2020; pp. 538–541. [Google Scholar] [CrossRef]
  15. Zhang, X.; Huang, Y.; Wang, S.; Meng, W.; Li, G.; Xie, Y. Motion planning and tracking control of a four-wheel independently driven steered mobile robot with multiple maneuvering modes. Front. Mech. Eng. 2021, 16, 504–527. [Google Scholar] [CrossRef]
  16. Luan, Y.; Wang, H.; Li, X.; Xu, W.; Huang, R.; Lv, J. Design of Motion Control System for Omnidirectional Four-Drive Mobile Robot. In Proceedings of the 2019 IEEE 8th Joint International Information Technology and Artificial Intelligence Conference (ITAIC), Chongqing, China, 24–26 May 2019; pp. 1409–1413. [Google Scholar] [CrossRef]
  17. Suseno, E.W.; Ma’Arif, A. Tuning of PID Controller Parameters with Genetic Algorithm Method on DC Motor. Int. J. Robot. Control Syst. 2021, 1, 41–53. [Google Scholar] [CrossRef]
  18. Hoffman, G.M.; Tomlin, C.J.; Montemerlo, M.; Thrun, S. Autonomous Automobile Trajectory Tracking for Off-Road Drriving: Controller Design, Experimental Validation and Racing. In Proceedings of the 2007 American Control Conference, New York, NY, USA, 9–13 July 2007; pp. 2296–2301. [Google Scholar] [CrossRef]
  19. Snider, J.M. Automatic Steering Methods for Autonomous Automobile Path Tracking; Tech. Rep. CMU-RITR-09-08; Robotics Institute: Pittsburgh, PA, USA, 2009; pp. 1–78. [Google Scholar]
  20. Jia, Q.; Chang, C.; Liu, S.; Zhang, L.; Zhang, S. Motion Control of Omnidirectional Mobile Robot Based on Fuzzy PID. In Proceedings of the 2019 Chinese Control And Decision Conference (CCDC), Nanchang, China, 3–5 June 2019; pp. 5149–5154. [Google Scholar] [CrossRef]
  21. Thrun, S.; Montemerlo, M.; Dahlkamp, H.; Stavens, D.; Aron, A.; Diebel, J.; Fong, P.; Gale, J.; Halpenny, M.; Hoffmann, G.; et al. Stanley: The robot that won the DARPA Grand Challenge. J. Field Robot. 2006, 23, 661–692. [Google Scholar] [CrossRef]
  22. Kumar, U.; Sukavanam, N. Backstepping Based Trajectory Tracking Control of a Four Wheeled Mobile Robot. Int. J. Adv. Robot. Syst. 2008, 5, 38. [Google Scholar] [CrossRef]
  23. Fu, W.; Wang, X.; Zhang, X. Rollover Stability of Heavy-Duty AGVs in Turns Considering Variation in Friction Coefficient. Lubricants 2023, 11, 119. [Google Scholar] [CrossRef]
  24. Zhou, X.; Jin, L.; Liu, Y. Modeling and Simulation Research of Heavy-duty AGV Tracking Control System Based on Magnetic Navigation. J. Phys. Conf. Ser. 2021, 1746, 012021. [Google Scholar] [CrossRef]
  25. Liu, S.; Wang, Y. Dynamic Simulation of Differential Driving Cargo Transport Vehicle. J. Intell. Manag. Decis. 2023, 2, 38–45. [Google Scholar] [CrossRef]
  26. Zhang, D.; Zhu, Z.; Zhang, H. Design of AGV Chassis Motion Control System Based on MWorks. J. Phys. Conf. Ser. 2023, 2479, 012056. [Google Scholar] [CrossRef]
  27. Kebbati, Y.; Ait-Oufroukh, N.; Ichalal, D.; Vigneron, V. Lateral control for autonomous wheeled vehicles: A technical review. Asian J. Control 2023, 25, 2539–2563. [Google Scholar] [CrossRef]
  28. Riofrio, A.; Sanz, S.; Boada, M.J.L.; Boada, B.L. A LQR-Based Controller with Estimation of Road Bank for Improving Vehicle Lateral and Rollover Stability via Active Suspension. Sensors 2017, 17, 2318. [Google Scholar] [CrossRef]
  29. Kebbati, Y.; Ait-Oufroukh, N.; Vigneron, V.; Ichalal, D. Neural Network and ANFIS based auto-adaptive MPC for path tracking in autonomous vehicles. In Proceedings of the 2021 IEEE International Conference on Networking, Sensing and Control (ICNSC), Xiamen, China, 3–5 December 2021; Volume 1, pp. 1–6. [Google Scholar] [CrossRef]
  30. Amer, N.H.; Hudha, K.; Zamzuri, H.; Aparow, V.R.; Abidin, A.F.Z.; Kadir, Z.A.; Murrad, M. Adaptive modified Stanley controller with fuzzy supervisory system for trajectory tracking of an autonomous armoured vehicle. Robot. Auton. Syst. 2018, 105, 94–111. [Google Scholar] [CrossRef]
  31. Zhou, Y.; She, J.; Wang, F.; Iwasaki, M. Disturbance Rejection for Stewart Platform Based on Integration of Equivalent-Input-Disturbance and Sliding-Mode Control Methods. IEEE/ASME Trans. Mechatron. 2023, 28, 2364–2374. [Google Scholar] [CrossRef]
  32. Guo, Q.; Chai, L.; Liu, H. Anti-swing sliding mode control of three-dimensional double pendulum overhead cranes based on extended state observer. Nonlinear Dyn. 2023, 111, 391–410. [Google Scholar] [CrossRef]
  33. Gudetti, J.; Panchal, T.; Bastiaan, J. An Analysis of the Vehicle Dynamics Behind Pure Pursuit and Stanley Controllers; SAE International: Warrendale, PA, USA, 2023. [Google Scholar] [CrossRef]
  34. Elias, G.H.S.; Al-Moadhen, A.; Kamil, H. Lateral control of an autonomous vehicle based on salp swarm algorithm. AIP Conf. Proc. 2023, 2591, 030043. [Google Scholar] [CrossRef]
  35. AbdElmoniem, A.; Osama, A.; Abdelaziz, M.; Maged, S.A. A path-tracking algorithm using predictive Stanley lateral controller. Int. J. Adv. Robot. Syst. 2020, 17, 1729881420974852. [Google Scholar] [CrossRef]
  36. Manikandan, S.; Kaliyaperumal, G.; Hakak, S.; Gadekallu, T.R. Curve-Aware Model Predictive Control (C-MPC) Trajectory Tracking for Automated Guided Vehicle (AGV) over On-Road, In-Door, and Agricultural-Land. Sustainability 2022, 14, 12021. [Google Scholar] [CrossRef]
Figure 1. Structure of AGV Motion Control System.
Figure 1. Structure of AGV Motion Control System.
Sensors 23 07219 g001
Figure 2. AGV vehicle motion is illustrated. (a) Forward kinematics (the rotation center does not lie on the x-axis of the relative coordinate system). (b) Inverse kinematics (the rotation center lies on the x-axis of the relative coordinate system).
Figure 2. AGV vehicle motion is illustrated. (a) Forward kinematics (the rotation center does not lie on the x-axis of the relative coordinate system). (b) Inverse kinematics (the rotation center lies on the x-axis of the relative coordinate system).
Sensors 23 07219 g002
Figure 3. Simulation of AGV vehicle’s displacement in the X and Y axes, motion trajectory, and angular velocity. (a) Displacement in the X-axis; (b) Displacement in the Y-axis; (c) Circular motion trajectory; (d) Angular velocity.
Figure 3. Simulation of AGV vehicle’s displacement in the X and Y axes, motion trajectory, and angular velocity. (a) Displacement in the X-axis; (b) Displacement in the Y-axis; (c) Circular motion trajectory; (d) Angular velocity.
Sensors 23 07219 g003
Figure 4. Illustration of Stanley Algorithm for AGV Vehicles.
Figure 4. Illustration of Stanley Algorithm for AGV Vehicles.
Sensors 23 07219 g004
Figure 5. Schematic Diagram of PID Controller.
Figure 5. Schematic Diagram of PID Controller.
Sensors 23 07219 g005
Figure 6. Trial-and-Error Method for PID Parameter Tuning.
Figure 6. Trial-and-Error Method for PID Parameter Tuning.
Sensors 23 07219 g006
Figure 7. Stanley-PID Control Principle.
Figure 7. Stanley-PID Control Principle.
Sensors 23 07219 g007
Figure 8. (a) Simulation Results of Stanley Control; (b) Velocity Time Interval Curve. The time interval refers to the time gap between updating the AGV state and plotting the path/vehicle status in each cycle.
Figure 8. (a) Simulation Results of Stanley Control; (b) Velocity Time Interval Curve. The time interval refers to the time gap between updating the AGV state and plotting the path/vehicle status in each cycle.
Sensors 23 07219 g008
Figure 9. Simulation Results of PID Control (a) Step Response Curve; (b) Comparative Step Response Curve; (c) Error Response Curve; (d) Sinusoidal Tracking.
Figure 9. Simulation Results of PID Control (a) Step Response Curve; (b) Comparative Step Response Curve; (c) Error Response Curve; (d) Sinusoidal Tracking.
Sensors 23 07219 g009
Figure 10. Simulation Analysis of Stanley-PID Motion Trajectory Control. (a) Sinusoidal Tracking Curve; (b) Path Error Curve; (c) Rotation Angle Curve; (d) Error Response Curve.
Figure 10. Simulation Analysis of Stanley-PID Motion Trajectory Control. (a) Sinusoidal Tracking Curve; (b) Path Error Curve; (c) Rotation Angle Curve; (d) Error Response Curve.
Sensors 23 07219 g010
Figure 11. Error Curve. (a) PID Error; (b) Stanley Error.
Figure 11. Error Curve. (a) PID Error; (b) Stanley Error.
Sensors 23 07219 g011
Table 1. The main motion parameters of the AGV.
Table 1. The main motion parameters of the AGV.
SymbolsDescriptionSymbolsDescription
A (x1,y1)Left front steering wheelV1Velocity of the left front wheel
B (x2,y2)Right front steering wheelV2Velocity of the right front wheel
C (x3,y3)Left rear steering wheelV3Velocity of the left rear wheel
D (x4,y5)Right rear steering wheelV4Velocity of the right rear wheel
θCurrent steering angle of the steering system as a wholeVISpeed of the centroid
θIAngle between the velocity direction of the centroid and Y1ωAngular velocity of the vehicle’s center point
αSteering angle of the left front wheel2HLateral axle distance
βThe steering angle of the right front wheel2LLongitudinal axle distance
γSteering angle of the left rear wheelOIRotation center of the vehicle
ηSteering angle of the right rear wheelIDistance from the steering wheel to the center point of the vehicle
VixLongitudinal velocity of the steering wheelsRRadius from the steering wheel to the rotation center
ViyLateral velocity of the steering wheelsRiRadii from the four steering wheels to the rotation center
aLateral coordinate of the turning centerbLateral coordinate of the rotation center
Table 2. AGV vehicle inverse kinematics simulation results.
Table 2. AGV vehicle inverse kinematics simulation results.
Left Front Steering Wheel 1Right Front Steering Wheel 2Right Rear Steering Wheel 3Left Rear Steering Wheel 4
Angle (rad)0.33795−0.6227−0.37950.6227
velocity (m/s)0.24220.15390.24220.1539
Table 3. Comparison of Controller Advantages and Disadvantages.
Table 3. Comparison of Controller Advantages and Disadvantages.
Controller TypeAdvantagesDisadvantages
Linear Quadratic Regulator (LQR) [28]Strong Stability and Robustness.Overly dependent on system models and not suitable for nonlinear systems; complex computation and storage for large-scale systems.
Model Predictive Control (MPC) [29]More suitable for path tracking.Complex design and higher cost.
Pure Pursuit Control (PPC) [30]No need for model prediction and algorithm optimization; fast response; applicable to various systems.Existence of static errors without self-correction capability.
Sliding Mode Control (SMC) [31,32]Good robustness; low system model requirement.Measurement errors have significant impact on its performance; Exhibits oscillations.
PID control [11,14,20]Simple computation; strong adaptability; fast response speed; strong path tracking ability; good robustness; real-time and easy-to-implement performance.Unable to adapt to variations in system parameters.
Stanley control [10,33,34]Simple computation; strong adaptability; fast response speed; strong path tracking ability; good robustness; real-time and easy-to-implement performance.Specific scenarios and requirements need to be considered.
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

Fu, W.; Liu, Y.; Zhang, X. Research on Accurate Motion Trajectory Control Method of Four-Wheel Steering AGV Based on Stanley-PID Control. Sensors 2023, 23, 7219. https://doi.org/10.3390/s23167219

AMA Style

Fu W, Liu Y, Zhang X. Research on Accurate Motion Trajectory Control Method of Four-Wheel Steering AGV Based on Stanley-PID Control. Sensors. 2023; 23(16):7219. https://doi.org/10.3390/s23167219

Chicago/Turabian Style

Fu, Weijie, Yan Liu, and Xinming Zhang. 2023. "Research on Accurate Motion Trajectory Control Method of Four-Wheel Steering AGV Based on Stanley-PID Control" Sensors 23, no. 16: 7219. https://doi.org/10.3390/s23167219

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop