Trajectory Tracking Control for WMRs with the Time-Varying Longitudinal Slippage Based on a New Adaptive SMC Method
Wheeled mobile robots (WMRs) in real complex environments such as on extraterrestrial planets are confronted with uncertain external disturbances and strong coupling of wheel-ground interactions while tracking commanded trajectories. Methods based on sliding mode control (SMC) are popular approaches for these situations. Traditional SMC has some potential problems, such as slow convergence, poor robustness, and excessive output chattering. In this paper, a kinematic-based feed-forward control model is designed for WMRs with longitudinal slippage and applied to the closed-loop control system for active compensation of time-varying slip rates. And a new adaptive SMC method is proposed to guide a WMR in trajectory tracking missions based on the kinematic model of a general WMR. This method combines the adaptive control method and a fast double-power reaching law with the SMC method. A complete control loop with active slip compensation and adaptive SMC is thus established. Simulation results show that the proposed method can greatly suppress chattering and improve the robustness of trajectory tracking. The feasibility of the proposed method in the real world is demonstrated by experiments with a skid-steered WMR on the loose-soil terrain.
Wheeled mobile robots (WMRs) have been widely utilized for exploration tasks on both earth and extraterrestrial bodies. Many current researchers make assumptions that the wheels and the ground have no relative slip or skidding, to simplify the description and analysis of the external uncertainty. However, when WMRs locomote on soft or rugged terrain, which is a nonholonomic constraint system as in [1, 2], control laws developed with the ideal assumptions may not ensure a decent real-time performance of tracking trajectories.
Some researchers performed a series of studies on the dynamic interaction between WMRs’ wheels and unstructured terrain [3–5]. They intended to reveal the mechanism of the occurrence of slippage and skid, and thus, the control model can be theoretically accurate. But due to the complexity of a dynamic integral model and the difficulty of making necessary measurements, these mechanism-based control laws have been difficult to be directly applied to real WMRs so far. On the other hand, kinematic models are relatively concise and easy to establish. They are often utilized with different control laws [6, 7] for real-time applications. However, these methods usually treat the uncertainty of WMRs on soft or rugged terrains as external interferences, which greatly decrease their robustness in real environments.
The capability of WMR tracking trajectories can be viewed as a nonlinear question which is strongly coupled with real environments and WMR models. Sliding mode control (SMC) is a popular approach for trajectory tracking under these circumstances. The reaching law generally has a significant effect on the performance of the entire SMC loop. The constant reaching law  is easy to implement but has a low convergence rate. An exponential reaching law  can converge quickly but suffers from obvious chattering when approaching the sliding surface. The power reaching law  can be relatively steady around the sliding surface, but its convergence is slow when the state of the system is far from the steady-state surface. Therefore, some researchers have endeavored to balance these characteristics to find solutions for practical problems. Matraji et al.  applied the double-power reaching law to solve the control problem for the descending stage for a soft landing on an asteroid. Gu et al.  designed a double-power reaching rate for near space vehicle control, which guarantees good dynamic characteristics of the trajectory tracking.
Although the methods mentioned above have some positive characteristics in certain circumstances, they still lack the ability to suppress output chattering. This can cause unpredictable results for robots’ motion in complex environments. Therefore, adaptive control is necessary for the situations when the task requirements put a high priority on stability. Liu et al.  applied fuzzy wavelet neural networks to SMC for robot manipulators, achieving a better performance by compensating for the estimated uncertainty. Yen et al.  proposed an adaptive fast double-power approach for motion tracking of a two dimensional table servo system. Wang et al.  proposed an adaptive second-order SMC approach for the trajectory tracking of a skid-steered WMR to overcome external disturbances and parametric uncertainty. These methods have demonstrated that adaptive methods can improve the robustness of the control systems.
This paper analyzes the process of the WMR’s locomotion coupled with longitudinal slippage when performing skid-steering. An active feed-forward slip compensation model of time-varying slip rates is developed. We then focus on the common trajectory tracking problem and propose a new adaptive SMC method with a fast double-power reaching rate. A complete control loop for trajectory tracking is thus established. A series of simulations and experiments on the loose-soil terrain were performed to demonstrate the feasibility of the proposed control method.
The reminder of the paper is organized as follows. The common kinematic model of a skid-steered WMR is presented in Section 2. The steering locomotion process coupled with time-varying slippage is analyzed in Section 3. The new adaptive SMC law is proposed with necessary derivations, and the entire control loop is presented in Section 4. The simulation results for the WMR tracking different trajectories are shown and analyzed in Section 5. The experiment results using the proposed control method for WMR tracking trajectories in a real complex environment are shown in Section 6. Finally, the conclusion is presented in Section 7.
2. The Kinematic Model of the WMR
The common and simplified two-wheel kinematic model of a WMR is illustrated in Figure 1. We assume the wheels of both sides can only move longitudinally to perform skid steering. A general four-wheeled mobile robot can be deemed as sharing the same kinematic model previously mentioned when the wheels in the same side rotate in an equivalent velocity. The position of the steering center in a two-dimensional global coordinate frame is .
In Figure 1, the skid-steering center is marked by . The geometric centers of the equivalent wheels on both sides are collinear with with a spacing of . The diameter of the wheels is . Variables and are the commanded linear and angular velocity of the steering center, respectively. Variable is the current included angle between and the positive direction of axis. The kinematic model of the WMR is then written as
Let be the desired pose of the WMR. The pose error between the current and desired poses, in the local coordinate system of the WMR, is described as
The differential form of the pose error is therefore described as
The local coordinate frame and positive directions attached the robot body and equivalent wheels while skid-steering is as illustrated in Figure 2. and are the commanded linear velocities of equivalent wheels in both sides, respectively, which are parallel to . and are the commanded angular velocities of the left and right equivalent wheels, with collinear rotation axes. Positive directions of linear and angular velocities are as the arrows pointing.
According to the kinematic model of the WMR, the relationship between the locomotive states of the equivalent wheels and the steering center while having slippage is where and are the effective linear velocities of the equivalent wheels with slippage.
3. Active Feed-Forward Slip Compensation
Some researchers have managed to compensate for wheel slippage by predicting the probable slip rate with prior data [4, 15]. However, this approach relies on measured data in specific terrain conditions, which is not robust with respect to a changeable or unknown environment. In this paper, we consider the longitudinal slippage of a WMR as time-varying, so that online compensation is possible.
During our research on WMRs on surfaces with loose soil, we found that skids can occur when the slip rates of the two wheels are inharmonious or when the slope of the terrain is too steep. This complexity makes the skid model hard to predict and establish. On the other hand, the compensation of time-varying longitudinal slippages can be achieved by estimating the real-time slip rates of two equivalent wheels on both sides. Thus, when the effect on locomotion from the skid is weaker than that of slippage, we can compensate for the longitudinal slippage while treating skids as external bounded disturbances.
Under the condition that the internal mechanical transmission loss of a WMR is omitted, we define the slip rates of the equivalent wheels as where and are the slip rates of the left and right equivalent wheels.
According to and , we can describe the actual measured kinematic state of the WMR steering center as where , and are the velocity losses; and are the measured actual linear and angular velocities of the steering center.
We then find that where
Let be the active slip compensation control input calculated based on equation (9):
We can then actively compensate for the effect of the time-varying slippage of both equivalent wheels on both acceleration and velocity levels when the skid-steering of the WMR couples with the longitudinal slippage.
4. The Design of an Adaptive SMC Law
The slip compensation approach described above is insufficient to guarantee the performance of trajectory tracking in soft or rugged environments. Therefore, we designed a new adaptive SMC law to solve this problem.
According to the theorem in article : for any and , there is . The holds if and only if there is .
If , let the Lyapunov function be
If , there is
Thus, holds when . It means that will converge to zero when converges to zero and converges to “”.
Therefore, the sliding mode function is designed as
We chose the double-power reaching law as in article : where , , and .
The stability of equation (15) can be proved by selecting the Lyapunov function as . Because there is
Let the desired control input for the WMR be calculated based on the desired input trajectory. And the relative parameters in equations (14) and (17) can be calculated through the kinematic model in Section 2. is the measured actual kinematic state of the WMR as mentioned above. is the commanded kinematic state from the SMC control law. The actual locomotive error based on kinematics is , which satisfies for certain, where and are positive constant values. We use a general adaptive function to design the adaptive control input, where is the coefficient and is the positive adaptive value changing with time .
We can thus achieve the adaptive SMC control law based on equations (3), (14), and (17): where . and are the expected values about bounded interferences. There must exist positive constant values satisfying and . They are achieved from
The stability of the proposed adaptive SMC law in equation (18) is proved as follows. Let the Lyapunov function be where is a positive constant value.
We can then derive out that
The stability of equation (21) holds when . This means as long as satisfies the inequalities and , the stability holds.
By similarly analyzing the inequality about , there must exist which causes the inequality to hold obviously. We can thus achieve that the system tends to be stable in finite time referring to article .
Since and are uncertain and covariant with motion, the integral of can be too large. Therefore, we set threshold conditions to prevent the adaptive parameters from accumulating too fast: where and are small positive values.
After the establishment of the adaptive SMC control model, the entire control loop is achieved as illustrated in Figure 3. The structure is quite straightforward and the slip compensation has been discussed in Section 3.
5. Simulations and Analysis
We performed simulations on whether the active slip compensation is applied as feed-forward and whether the adaptive function is applied to the SMC in MATLAB on a platform with an Intel® G4600 CPU. The units were SI in all simulations.
5.1. Simulations on Active Slip Compensation
The traditional SMC with a fast double-power reaching law can be achieved by substituting the parameters in equation (18) as follows: where , , , and are positive values. The reason we chose the traditional SMC for comparison is that we want to show how much the slip compensation alone can improve the trajectory tracking performance of SMC without the adaptive functions.
We assumed that the time-varying slip rates were . The interval distance between the centers of two equivalent wheels was , and the simulated WMR’s geometric center started off from to follow a circular trajectory in a two-dimensional space. The commanded trajectory was described as , , and , where is the simulation time. The parameters used for the traditional SMC law were
The simulation results for the WMR’s motion while tracking the commanded circular trajectory are shown in Figure 4. The results for errors in the -direction, the -direction, and the steering angle are shown in Figures 5–7, respectively. The comparison of absolute error ratios for tracking the circular trajectory is shown in Table 1. The absolute error ratio is calculated from the accumulated simulation error divided by the accumulated desired output. The lower the absolute error ratio is, the better the capability of instantaneous responding is for that method.
When the slippage is time-varying and bounded, the traditional SMC law cannot promise steady tracking of a desired trajectory. On the other hand, trajectory tracking is obviously stable while applying slip compensation. Although active slip compensation leads to a higher error ratio in the -direction, it still promises lower error ratios in the -direction and the steering angle. The output chattering caused by external uncertainty is significantly suppressed. It means that the feed-forward control path we design is necessary for a WMR tracking trajectories in uncertain environments with wheel slippage.
5.2. Simulations of the Adaptive SMC
To show how the adaptive function affects the SMC performance, we designed a cosine curve as the target trajectory for a more complex simulation. The time-varying slip rates were set to . We assumed the WMR’s geometric center started from and tracked the cosine trajectory described by , , and , where is the simulation time. The parameters of the traditional SMC were the same as in the previous section. The adaptive SMC parameters were similarly set as
Both methods used for comparison were implemented by adding the active slip feed-forward. The simulation result for position changes while tracking the cosine trajectory in a two-dimensional space is shown in Figure 8. The comparisons for errors in the -direction, the -direction, and the steering angle are shown in Figures 9–11, respectively. The value changes of the adaptive functions are shown in Figure 12. Thus, we have shown that the chattering of the traditional SMC has been significantly suppressed by the adaptive function along the tracking process except around the first sharp turn. This is because the robustness is weak when the adaptive parameters are initially adjusting themselves. But once the adaptive adjustment is nearly finished, the robustness will be obviously better than methods without adaptive control.
The comparison of accumulated absolute error ratios for the cosine trajectory tracking is shown in Table 2. The accumulating error of the steering angle is quite large with both methods, because the steering angle constantly adjusts to the cosine curve and needs to turn sharply. The overall error of the adaptive SMC is slightly higher than that of the traditional SMC. This is because the adaptive adjustment of parameters can delay the response speed, resulting in higher error ratios in the system. The traditional SMC usually responds faster to the desired trajectory changing but has obviously more chattering. Therefore, the adaptive SMC is suitable for tracking missions putting priority to steadiness and smoothness, instead of the capability of instantaneous response. This feature makes our method appropriate for the trajectory tracking missions as mentioned in Section 1.
The chattering usually occurs during the starting period and rapid steering angle changing. From the simulations described above, we can conclude that both the active slip feed-forward and the adaptive control functions can significantly suppress the chattering of the system, without sacrificing much performance in simulations. The external interferences caused by slip loss and unpredictable errors were greatly suppressed. These improvements are important not only for simulations but also for practical usage. This is because the actual disturbances to a WMR in a real and complex environment are usually more unpredictable, which will be discussed in the following section.
6. Experiments and Analysis
To demonstrate the improvement to the performance of trajectory tracking by implementing the active slip compensation and the adaptive SMC, we performed a series of experiments with a WMR on loose soil. It carried a Raspberry Pi mounted by the ROS (Robot Operating System). The real-time actual pose of the WMR was measured by the OptiTrack visual measurement system. The experiment scene is shown in Figure 13. The units were SI in all experiments.
We performed cosine trajectory tracking experiments with four different methods. They were open-loop experiments with and without active slip compensation and closed-loop experiments using SMC with and without adaptive control. The control frequency was 17 Hz for all methods.
With the units being SI, the desired cosine trajectory was as , , and , where is the running time. The desired velocities were calculated using position and angular differentiation. The parameters for the traditional SMC and the adaptive SMC were set as
The experiment results of the WMR’s positions on loose soil are shown in Figure 14. The experiment results of errors in the -direction, the -direction, and the steering angle are shown in Figures 15–17, respectively. The value changes of the adaptive functions are shown in Figure 18. The slip rate changes of the WMR are shown in Figure 19. When the damping of the system is unpredictable, such as in our experiments where the WMR locomotes on loose soil, the chattering can obviously affect the overall trajectory tracking performance. The undulation of actual longitudinal slippage with the adaptive SMC was less severe than with traditional SMC as shown in the results.
The comparison of absolute error ratios of tracking the cosine trajectory with these different control methods is shown in Table 3. Although the traditional SMC can have lower error ratios according to the simulation results in the previous section, its lacking capability of suppressing the occurrence of chattering results in relatively worse tracking performance in our experiments. The adaptive SMC outperforms the other methods in all respects we are interested in.
It also should be mentioned that both the SMC methods failed when there was no slip feed-forward path and thus are not shown in the comparisons. The WMR lacking slip compensation gets stuck in spinning, which indicates that this feed-forward can be indispensable in a real complex environment.
In this paper, we described an active slip feed-forward compensation for the WMR control system based on the time-varying longitudinal slippage, which makes the trajectory tracking mission in complex environments such as on loose soil viable with the general WMRs. We proposed a new adaptive SMC with a fast double-power reaching law for the WMR to effectively track commanded trajectories. By combining the adaptive SMC with the slip feed-forward, the chattering of the WMR’s trajectory has been significantly suppressed. However, in our simulation, this results in slightly higher error rates than using the traditional SMC approach. To demonstrate the feasibility of the proposed method in complex environments, we conducted a series of trajectory tracking experiments on loose-soil terrain with our WMR using a ROS. The experimental results show that by reducing the chattering caused by the wheel-soil slippage and the control law, the tracking errors were significantly decreased. The method proposed in this paper outperforms all other competitors under similar experiment conditions in all respects we are interested in.
Although there were some positive results in the simulations and experiments, we found that the tracking errors are still not negligible during real-world experiments. The main reason is that sharp turns on soft terrain exceeded the mechanical capability of our WMR, resulting in wheels sinking into loose soil at some moments. This means that the current control scheme of continuously pushing the WMR forward should be improved in our further research for a better trajectory tracking performance.
The data used to support the findings of this study are available from the corresponding author upon request. Our SMC toolbox has been open-sourced in https://github.com/orcasdli/SMCinROS.
Conflicts of Interest
The author(s) declare(s) that they have no conflicts of interest.
This study was supported by the National Natural Science Foundation of China (Grant No. 51822502) and the National Basic Research Program of China (Grant No. 2013CB035502).
L. Ding, H. Gao, Z. Deng, K. Yoshida, and K. Nagatani, “Slip ratio for lugged wheel of planetary rover in deformable soil: definition and estimation,” in 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 3343–3348, St. Louis, MO, USA, October 2009.View at: Publisher Site | Google Scholar
D. Liang, G. Haibo, G. Junlong, L. Nan, D. Guangren, and L. Ximin, “Terramechanics-based analysis of slipping and skidding for wheeled mobile robots,” in Proceedings of the 31st Chinese Control Conference, pp. 4966–4973, Hefei, China, 2012.View at: Google Scholar
M. Partovibakhsh and G. Liu, “Slip ratio estimation and control of wheeled mobile robot on different terrains,” in 2015 IEEE International Conference on Cyber Technology in Automation, Control, and Intelligent Systems (CYBER), pp. 566–571, Shenyang, China, 2015.View at: Publisher Site | Google Scholar
H. X. Zhang, J. S. Fan, F. Meng, and J. F. Huang, “A new double power reaching law for sliding mode control,” Control and Decision, vol. 28, no. 2, pp. 289–293, 2013.View at: Google Scholar
C. Gu, J. Jiang, and Y. Wu, “Tracking control for a near-space vehicle in the ascent phase,” Journal of Harbin Engineering University, vol. 37, no. 11, pp. 1526–1531, 2016.View at: Google Scholar
V. T. Yen, W. Y. Nan, P. van Cuong, N. X. Quynh, and V. H. Thich, “Robust adaptive sliding mode control for industrial robot manipulator using fuzzy wavelet neural networks,” International Journal of Control, Automation and Systems, vol. 15, no. 6, pp. 2930–2941, 2017.View at: Publisher Site | Google Scholar
L. Ding, S. Li, Y. J. Liu, H. Gao, C. Chen, and Z. Deng, “Adaptive neural network-based tracking control for full-state constrained wheeled mobile robotic system,” IEEE Transactions on Systems, Man, and Cybernetics: Systems, vol. 47, no. 8, pp. 2410–2419, 2017.View at: Publisher Site | Google Scholar
W. Wu, H. Chen, and Y. Wang, “Global trajectory tracking control of mobile robots,” Acta Automatica Sinica, vol. 27, no. 3, pp. 326–331, 2001.View at: Google Scholar