1. Introduction
In the last decade years, mobile robot has been developed as industrial Autonomous Mobile Robot (AMR) with high nonlinearities that are often unknown and time-varying. Therefore, if we want to design a controller for mobile robot, we should consider that the exact path-following(PF) performance, which is concerned with the ability to drive a mobile robot autonomously as close as possible to a previously defined reference path [1].
Wheeled mobile robots have many application fields in industrial and service robotics, particularly when flexible motion capabilities are required on reasonably smooth grounds and surfaces [2]. They are especially necessary for tasks that are difficult and dangerous for men to perform. Many researchers have shown interest in mobile robots. Most of them have focused on trajectory tracking—to control the robot to follow a desired trajectory, and point stabilization—to stabilize a robot at a desired point[2].
Among the many control strategies that have been proposed for various non-holonomic systems, research results can generally be classified into two classes. The first class is kinematic control, which provides the solutions only at the pure kinematic level, where the systems are represented by their kinematic models and velocity acts as the control input. Based on exact system kinematic, different control strategies have been proposed [3-4].
In this paper, the adaptive following control is used as a following controller of mobile robot [5-6]. And also, a classical PID approach is applied for the path-following controller, which is the control strategy most frequently used in the industry. A very simple model of the mobile robot kinematics is used and thus a robust PID tuning is necessary. PIDs advantages include simplicity, robustness and their familiarity in the control community. Because of this, a great deal of effort has been spent to find the best choice of PID parameters for different process models.
2. Designing Controller
Contrary to the usual situation, tracking is easier than regulation for a non-holonomic AMR. An intuitive explanation of this can be given in terms of a comparison between the number of controlled variables (outputs) and the number of control inputs. For the two-wheel differential drive AMR robot of Section 2, two input commands are available while three variables (xi, yi and the orientation 𝜃i) are needed to determine its configuration. Thus, regulation of the AMR posture to a desired configuration implies zeroing three independent configuration errors. When tracking a trajectory, instead, the output pe has the same dimension as the input and the control problem is square.
Let us denote the current position of the AMR robot as pm, the velocity as \(\begin{align}\dot{p}_{m}\end{align}\). The Cartesian velocity \(\begin{align}\dot{p}_{m}\end{align}\), is represented in terms of joint variables as (1). So, the kinematics model of the robot is as tracking;
\(\begin{align}\dot{p}_{m}=J\left(p_{m}\right) \dot{q}_{m}\end{align}\) (1)
\(\begin{align}\left[\begin{array}{c}\dot{x}_{i} \\ \dot{y}_{i} \\ \dot{\theta}_{i}\end{array}\right]=\left[\begin{array}{cc}\cos \theta_{i} & 0 \\ \sin \theta_{i} & 0 \\ 0 & 1\end{array}\right]\left[\begin{array}{c}v_{m} \\ \omega_{m}\end{array}\right]=J\left(p_{m}\right) \dot{q}_{m}\end{align}\) (2)
Therefore, in ord er to obtain the real-time position of the AMR robot, we can control the control law as \(\begin{align}\dot{q}_{m}=\left[v_{m}, \omega_{m}\right]^{T}\end{align}\).
The tracking is the way to get the desired inputs of the AMR robot system mathematically. The issue of AMR robot trajectory tracking can generally be transformed into tracking one reference AMR robot. To assume the robot current position to be pm = [xi, yi, 𝜃i]T, and the speed to be \(\begin{align}\dot{q}_{m}=\left[v_{m}, \omega_{m}\right]^{T}\end{align}\), the reference mobile robot position is pm,r = [xr, yr, 𝜃r]T, and the speed to be \(\begin{align}\dot{q}_{m}=\left[v_{r}, \omega_{r}\right]^{T}\end{align}\), as shown in Fig. 1.
Fig. 1 Position error of mobile robot under Cartesian coordinate
To order pe = [xe, ye, 𝜃e]T = [xr- xi, yr - yi, 𝜃r- 𝜃i]T, and the AMR robot position error equation (3) is obtained from the geometric relationship shown in Fig. 1. The reference state in the robot coordinate is expressed as follow by the transformation from the world coordinate to the robot coordinate.
\(\begin{align}\begin{aligned} p_{e} & =\left[\begin{array}{l}x_{e} \\ y_{e} \\ \theta_{e}\end{array}\right]=\left[\begin{array}{ccc}\cos \theta & \sin \theta & 0 \\ -\sin \theta & \cos \theta & 0 \\ 0 & 0 & 1\end{array}\right]\left(p_{m, r}-p_{m}\right) \\ & =T_{e}\left(p_{m, r}-p_{m}\right)\end{aligned}\end{align}\) (3)
Then the position error differential equation is as tracking:
\(\begin{align}\dot{p}_{e}=\left[\begin{array}{c}\dot{x}_{e} \\ \dot{y}_{e} \\ \dot{\theta}_{e}\end{array}\right]=\left[\begin{array}{c}y_{e} \omega_{m}-v+v_{r} \cos \theta_{e} \\ -x_{e} \omega_{m}+v_{r} \sin \theta_{e} \\ \omega_{r}-\omega_{m}\end{array}\right]\end{align}\) (4)
Trajectory tracking of AMR robot based on kinematics mod el is to search the bounded input as \(\begin{align}\dot{q}_{m}=\left[v_{m}, \omega_{m}\right]^{T}\end{align}\), that causes position error vector, pe = [xe, ye, 𝜃e]T to be bounded , and \(\begin{align}\lim _{t \rightarrow \infty}\left\|\left[x_{e}, y_{e}, \theta_{e}\right]^{T}\right\|=0\end{align}\), with arbitrary initial error and the equation (4) controlled by the control law.
By using the error vector pe = [xe, ye, 𝜃e], the tracking curve in the robot coordinate can be calculated as follow;
\(\begin{align}\dot{r}_{e}=-v_{m} \cos \theta_{e}\end{align}\) (5)
\(\begin{align}\dot{\theta}_{e}=-\omega_{m}+\frac{v_{m} \sin \theta_{e}}{r_{e}}\end{align}\) (6)
\(\begin{align}\dot{\theta}_{r}=\frac{v_{m} \sin \theta_{e}}{r_{e}}\end{align}\) (7)
A Lyapunov candidate function is defined as in equation (8).
\(\begin{align}V=V_{1}+V_{2}=\frac{1}{2} \lambda r_{e}^{2}+\frac{1}{2}\left(\theta_{e}^{2}+h \theta_{r}^{2}\right)\end{align}\) (8)
where V1 means the error energy to the distance and V2 means the error energy in the direction. After differentiating both sides in equation in terms of time, we can acquire the result as in equation (9).
\(\begin{align}\dot{V}=\dot{V}_{1}+\dot{V}_{2}=\lambda r_{e} \dot{r}_{e}+\left(\theta_{e} \dot{\theta}_{e}+h \theta_{r} \dot{\theta}_{r}\right)\end{align}\) (9)
Therefore, using this controller for the AMR robot, \(\begin{align}\dot{V}\end{align}\) approaches to zero as t→∞; re and 𝜃e also approach almost to zero as shown in (10).
\(\begin{align}\dot{V}=-\lambda\left(\gamma \cos ^{2} \theta_{e}\right) r_{e}^{2}-k \theta_{e}^{2} \leq 0\end{align}\) (10)
PID algorithm is proposed for controlling position and velocity of the AMR robot platform like shown in Fig. 2. Using the PID algorithm, we can control the important system characteristics, let say us, rising time, steady state error, system stability, etc. Each term in the control algorithm has a different effect on the system characteristics. In the PID control, the input for control of a standard PID controller in continuous time is stated as in equation (11).
\(\begin{align}\begin{aligned} m(t) & =K\left[e(t)+\frac{1}{T_{i}} \int_{0}^{t} e(\tau) d \tau+T_{d} \frac{d e(t)^-}{d t}\right. \\ & =K_{p} e(t)+K_{i} \int_{0}^{t} e(\tau) d \tau+K \frac{d e(t)^-}{d t}\end{aligned}\end{align}\) (11)
Fig. 2 Control system diagram
where e(t) represents error signal that is the difference between desired input and output signal. For the digital control PID equation in discrete time is expressed as equation (11).
Fig. 3 PID controller diagram
3. Simulation Results
In order to test the method of this paper, the controller is simulated with the circular track as reference trajectory.
The reference track is as x2 + y2 = 1.252, the reference velocity is as νr = 0.2, and the reference angular velocity is as ωr = 0.2. While the initial velocity is as νm = 0.4, and the initial angular velocity is as ωm = 0.3, the initial position is as . pm = (-3, 0, 2π/3)T.
The simulation results are shown in Fig. 4. and Fig. 5. From the results, it shows that the AMR robot starts from an initial position and then is trying to track the desired line. It takes a short time to follow up the desired line and land on the desired path smoothly.
Fig. 4 Path following for the AMR robot
Fig. 5 Following error: xe, ye, and 𝜃e
4. Conclusion
This paper presents an adaptive tracking controller for AMR robot based on a robust PID method. The proposed controller has a parallel structure that consists of PID controller with a fixed gain. The principal advantage of the present methodology is that it uses a very simple mod el for the mobile robot which allows the tuning of a simple PID controller. The new method for the robust tuning of the PID controller is based on classical concepts and can be applied to integrative process plus a delay. The simple and clear control laws lead to simplicity of adjusting the parameters to achieve the desired performance including the tracking error and control signals. Stability of system has been guaranteed by appropriate choice of Lyapunov functions. Simulations have shown robustness and efficiency of this method. For the future work, robust tuning and position estimation should be considered to realize more accurate motions of AMR robots.
References
- Tae-Seok Jin, "LQ control by linear model of Inverted Pendulum Robot for Robust Human Tracking," Journal of Korean Society of Industry Convergence, vol.23, no.1, pp.49-55, 2020.
- T.D.C. Thanh, K.K. Ahn, Nonlinear PID control to improve the control performance of 2 axes pneumatic artificial muscle manipulator using neural network, Mechatronics, vol.16, pp. 577- 587, 2006.
- K. J. Astrom and T. Hagglund, "Revisiting the ziegler-nichols step response method for PID control," Journal of Process Control, vol.14, pp. 635-650, 2004.
- A. Fadaei and K. Salahshoor "A Novel Real-time Fuzzy Adaptive Auto-Tuning Scheme for Cascade PID Controllers," International Journal of Control, Automation, and Systems, vol.9, no.5, pp.822-823, 2011.
- L. Yu, S. Fei, and X. Li "RBF Neural Networks-Based Robust Adaptive Tracking Control for Switched Uncertain Nonlinear Systems," International Journal of Control, Automation, and Systems, vol.10, no.2, pp. 437-443, 2012.
- Tae-Seok Jin, "Voice Command-based Prediction and Follow of Hu man Path of Mobile Robots in AI Space," Journal of Korean Society of Industry Convergence, vol.26, no.2, pp.225-230, 20230.