Abstract
In recent years, the agricultural applications of unmanned vehicles have garnered significant attention thanks to the rapid development of global positioning systems, inertial navigation technology, and control theory. In this study, a novel sliding mode controller for farm vehicles lateral path tracking control in the presence of unknown disturbances is created. Based on the standard kinematic model and the study of agricultural circumstances, the kinematic error model with unknown external disturbances and severe nonlinearity is initially constructed. To deal with the disturbances that exist in the lateral path tracking system, this work offers a finite-time disturbance observer-based composite terminal sliding mode control (FDOB-CTSMC). Meanwhile, the finite-time disturbance observer-based composite adaptive terminal sliding mode control (FDOB-CATSMC) is developed on the basis of the sliding mode filter and the adaptive control technology, which will significantly reduce the controller chattering issue. Using the Lyapunov theory, the finite-time convergence of the lateral deviation and the sliding variable can be verified. The numerical simulations demonstrate that the proposed controller is far better than the traditional path tracking controllers.
Similar content being viewed by others
Explore related subjects
Discover the latest articles, news and stories from top researchers in related subjects.Avoid common mistakes on your manuscript.
1 Introduction
The aging population and labor shortage are becoming increasingly serious around the world, and these phenomena promote the need for mechanization and automation in industry, agriculture, etc. [1, 2]. Benefits from the rapid development of global positioning systems, inertial navigation technology, and control theory, unmanned farm vehicles are gradually being utilized in agricultural activities such as plowing, harvesting, and spraying [3]. Precision, unmanned, and standardization are all trends in modern agriculture [4].
Path tracking control is one of the foundational technologies for unmanned agricultural vehicles [5]. The path tracking control of farm vehicles, i.e., forcing the vehicles to track the predetermined path [6]. Capabilities of autonomous high-precision tracking can increase operations quality and ecological benefit to some extent [7]. However, the agricultural environment is complex and full of unknown disturbances, as opposed to structured scenarios. For instance, the operating environment includes slippery slopes, sandy, sloppy grass grounds, and stony grounds [8]. The pure rolling constraint no longer exists, and the wheel slips are inevitable. Wheel slip, according to vehicle dynamic knowledge, is reflected in the influence on the speed of the front and rear wheels, i.e., it may exist uncertainties [9]. On the other hand, for instance, while plowing, the longitudinal dynamic model is impacted by the ground resistance, and perfect motion can hardly be maintained. Also, the kinematic model contains strong nonlinearity and unmodeled error, which might be viewed as the internal disturbance. As a result, it is eager to design a path tracking controller, which is easy to deploy and robust against unanticipated disturbances.
Massive control strategies for vehicles have been implemented in recent years, including optimal control (linear quadratic regulator [10], model predictive control [11,12,13]), control design via the Lyapunov method [14], Proportional-Integral-Differential (PID) control [15], and Pure Pursuit control (PPC) [16]. These methods are typically categorized as kinematic model-based or dynamic model-based. Among these studies mentioned above, the dynamic model is typically assumed to be precisely known. Unfortunately, factors such as wind forces, road adhesion, road surface conditions, and others make mathematical modeling of vehicle dynamics difficult. Furthermore, it has also been demonstrated that the path tracking controller developed using the kinematic model is appropriate for achieving satisfactory tracking accuracy for low-speed farm vehicles [17, 18]. Meanwhile, from a universal standpoint, the kinematic model-based controller is a better option for farm vehicles. The kinematic model-based robust path tracking controller design is still a hot open issue.
To the best of our knowledge, few papers took unknown disturbances into account. In [19], the kinematic model was developed with the lateral and longitudinal uncertainty velocities in mind. In [20], the nonlinear disturbance observer (NDO) was employed to reckon the influence of unknown disturbances, and an enhanced sliding mode controller was developed. However, disturbance suppression is dependent on high gain and high-frequency control, as well as the prior knowledge of the perturbation’s upper bound value. Active disturbance rejection control (ADRC) was employed by [21, 22] to accomplish lateral control under uncertainties, nonetheless, the converge rate is asymptotic. According to the aforementioned studies, the time-varying uncertainties and strong nonlinearity will act on the unmatched channel, indicating that the mismatched disturbance exists. However, the conventional control techniques can hardly handle the mismatched disturbance.
Sliding mode control (SMC) is an established method for rejecting disturbances. Due to its insensitivity to perturbations and ease of implementation, SMC has been implemented in a variety of fields, including power electronics [23], yaw moment control [24], motion control [25], etc. In addition, many excellent SMC theories have emerged [26,27,28,29,30, 43]. SMC has also been employed in farm vehicle path tracking control. Wu et al. [31] proposed extended state observer (ESO) based terminal sliding mode control (ESOB-TSMC). However, the convergence rate of ESO is asymptotic, and the hyperbolic tangent function suppressed the chattering at the expense of control accuracy. Experiments demonstrated the effectiveness of a novel continuous sliding surface designed for articulated vehicles in [32]. The aforementioned investigations demonstrated the feasibility and viability of SMC for farm vehicles’ path tracking control, yet some problems remain. As we all know, the traditional SMC suppressed disturbances by utilizing a discontinuous sign function, which made chattering inevitable [33]. Meanwhile, it is necessary to have the prior knowledge about the perturbation’s upper bound. In practice, obtaining the upper bound of the perturbation is challenging. Various techniques, such as the boundary-layer method [34] and the higher-order SMC method [35], have been developed to combat the chattering problem. However, due to the fact that sliding variable in a boundary layer has linear motion, the boundary-layer approach reduces control precision [34]. Higher-order SMC diminishes chattering while increasing the order of the considered system [35]. Notably, [36] developed a new adaptive sliding mode method in which the adaptive technology is used to determine the optimal value of the sliding mode controller’s gain, which inspired our research. In [36], a loss-pass filter (LPF) was used to accomplish the equivalent control; however, the LPF’s time constant will affect control accuracy as well as hardware performance requirements. On the other hand, time-varying uncertainties will cause mismatched disturbances in the lateral path tracking system. Disturbance observer-based SMC is an emerging technique for addressing mismatched disturbances. References [20, 37] all used NDO to estimate the mismatched disturbances, but the mismatched disturbance must be constant rather than time-varying. Linear ESO was applied in [21], and it has been proved to be asymptotically convergent. A precise and rapid estimation of mismatched disturbance is the perennial area of research interest.
This paper proposes a composite adaptive terminal sliding mode control (CATSMC) to address the previously listed issues. The FDO is employed to estimate the mismatched disturbance, which ensures that the disturbances are estimated in a finite time rather than asymptotically. Inspired by Uktin’s work, an adaptive law is used to construct the integral TSMC in order to achieve the least optimal control gain, which can significantly minimize the chattering issue. Finally, several simulation results under various scenarios are presented to prove the validity of the proposed control frame. This study’s creativity and significant contributions can be outlined as follows:
-
(1)
The path-tracking error model is converted to a second-order system, which includes both mismatched and matched disturbances. The FDO is capable of estimating the mismatched lump disturbance in a finite time as opposed to doing asymptotically.
-
(2)
An innovative FDOB-CATSMC technique for lateral path tracking of agricultural vehicles is proposed. It can provide a guarantee that the lateral deviation and the sliding variable will converge to stable in a finite time.
-
(3)
Combined with a high-frequency signal filter, the proposed adaptive controller can reduce chattering, and meanwhile maintaining the disturbance rejection ability.
This paper is structured as follows. In Sect. 2, we will describe the kinematic and error models of the path tracking system in presence of disturbances. The first-order SMC (FOSMC), the FDOB-CTSMC and the FDOB-CATSMC are all introduced, along with their respective designs and stabilities, in Sect. 3. The numerical simulations in Sect. 4 demonstrate the efficiency of the proposed composite control algorithm. Section 5 describes the conclusions.
2 System description and modeling
2.1 Notation and problem statement
The Frenet–Serret frame, as shown in Fig. 1, is applied to delineate path tracking control for farm vehicles. XOY denotes the inertial coordinate frame, and the reference path is planned in the Frenet–Serret frame, which allows the longitudinal and lateral motions to be decoupled [38]. The variables and notations required for the kinematic model and the error model are listed in Table 1.
2.2 Kinematic model and error model
The kinematic model of the farm vehicles in inertial coordination can be described as follows:
Neglecting the longitudinal motion, one has
The desired vehicle motion trajectory is set to
Decomposing in the Frenet–Serret frame, a more detailed error model is obtained as follows:
In fact, it should be emphasized that in agricultural scenarios, uncertainties such as unexpected wheel slippage, different drivers’ driving skills, external environment influences, and road surface will influence the tracking accuracy. Thus, ideal vehicle motion is difficult to maintain. The above-mentioned uncertainties finally reflect on the lateral subsystem and heading angle velocity, respectively. Hence, taking disturbances into account, and based on (2) and (3), the following equation is obtained by differentiating (4)
with \(f_0\) being the additive external time-varying disturbance, \(\omega _s(t)\) is the control input to be designed, and \(\omega _d\left( t \right) \) denotes the disturbance acts on the control input channel.
For the convenience of controller design, system (5) can be reformulated as follows:
where
It should be noted that \(f_1\) is the mismatched disturbance in the \(e_d\) subsystem, which contains model nonlinearity and external disturbances, and the same concept can be found in [21, 31].
Assumption 1
The lumped disturbances \(f_1\), \(f_2\) satisfy the following requirements:
-
(1)
\(f_i\) is differentiable twice;
-
(2)
\(\left| f_i^{\left( j \right) } \right| \le \phi _i,\,\,i=1,2;\,\,j=0,1,2,\)
where \(\phi _i>0\) denote unknown constants.
Remark 1
In practice, the lumped disturbances \(f_1\), \(f_2\) are all bounded. For instance, according to the vehicle dynamic knowledge, the wheel slips will influence the rear and front wheel velocity, but it will be far less than the linear velocity. Similarly, the road resistances are all bounded, hence Assumption 1 is reasonable.
The work aims to construct a robust controller for a agriculture vehicle with the following characteristics:
-
(1)
Instead of asymptotic convergence, the lateral deviation can be forced to origin within a finite time when unknown disturbances are considered;
-
(2)
The proposed method not only can significantly reduce the influences of mismatched and matched disturbances, but also suppress the chattering problem.
Remark 2
In practice, the lateral deviation is the most important factor to consider, as it has a direct impact on operation quality, efficiency, production cost, and so on. It is difficult to control both the lateral deviation and the heading deviation to zero under these conditions at the same time. The nested frame is capable of accommodating both lateral and heading deviation.
3 Lateral path tracking controller design
In this section, the SMC approaches are utilized to design the lateral path tracking controller for farm vehicles in the presence of unknown disturbances. First of all, the FOSM method is used to build the path tracking lateral controller. The FDOB-CTSMC is subsequently constructed to accommodate the unknown mismatched disturbance. In conjunction with the sliding mode-based filter and the adaptive control technology, the composite control method is intended to significantly increase tracking accuracy and reduce chattering.
The following notations and lemmas are given prior to the controller design. The signum function is defined as follows:
For the simplicity of expression, the fractional power is defined as \( \mathrm {sign}\left( x \right) ^r=\text {sign}\left( x \right) \left| x \right| ^r. \)
Notation \(\left[ x \right] _+\) denotes
Lemma 1
[39] For a continuous system \(\dot{x}\left( t \right) =f\left( x\left( t \right) \right) ,\, f\left( x(0) \right) =0,\, x\in {\mathbb {R}},\) suppose there exists a continuous positive definite function \(V: D\longrightarrow {\mathbb {R}}\), there exists real number \(\kappa _1>0,\,\,0<\alpha <1\), and an open neighborhood \({\mathscr {V}}\in \ D\) of the origin such that
then the origin is a finite-time stable equilibrium.
3.1 Design of FOSM lateral path tracking controller
For system (6), according to the control goal, the sliding manifold is chosen as
with \(\varrho >0\) is the design coefficient, which determines the convergence speed in the sliding manifold. Calculating the derivative of the sliding variable (8) and combining it with (6) yield
where \(\omega \triangleq \varrho f_1+f_2\). According to Assumption 1, \(\omega \) satisfies \(\text {sup}\left| \omega \right| \le {\mathscr {W}}\) and \({\mathscr {W}}>0\) denotes a positive constant.
The following theorem depicts the finite-time convergence characteristic of the sliding variable s.
Theorem 1
If the FOSM lateral path tracking controller is designed as
where \(k_1>{\mathscr {W}}\), it can conclude that the sliding variable s in (8) will converge to the equilibrium point within a finite time.
Proof
The first candidate Lyapunov function is chosen as \(V\left( s \right) =\frac{1}{2}s^2\), then taking the derivate and combining it with (10), we have
With the given condition \(k_1>{\mathscr {W}}\), one can draw the conclusion \(\dot{V}\left( s \right) \le -\mu V^{\frac{1}{2}}\left( s \right) \) and \(\mu =\sqrt{2}\left( k_1-{\mathscr {W}} \right) \). By using Lemma 1, we can conclude that the sliding variable s will converge to the equilibrium within a finite time. This completes the proof. \(\square \)
Then, system (6) will be reduced to
According to the solution of (12), the lateral error cannot be driven to the equilibrium point. The suppression of disturbances influence is dependent on a high gain \(k_1\); therefore, chattering is serious in FOSM. Also, the prior upper bound information of the unknown total disturbance is notoriously difficult to obtain, hence FOSM cannot be applied to handle farm vehicle lateral path tracking control. In order to solve the chattering issue, the FDOB-CTSMC will be developed next.
3.2 Design of FDOB-CTSMC lateral path tracking controller
In this section, the FDOB-CTSMC will be developed to eliminate the impacts of mismatched disturbance. A novel terminal sliding manifold based on the integral operation is proposed, the lateral deviation and the sliding variable can converge to the equilibrium points within a finite time, which can be strictly proved by using the Lyapunov theory.
3.2.1 Design of FDO
First of all, the FDO is designed as follows:
where \(z_2\) and \(z_3\) are the estimations of \(f_1\) and \(\dot{f}_1\), respectively; \(L_i>0\,\,\left( i=1,2,3 \right) \) are the observer parameters which needed to be designed.
Lemma 2
If the observer is constructed as illustrated in (13) and the corresponding parameters are correctly specified, the mismatched disturbance and its derivate can be approximated by \(z_2\) and \(z_3\) in a finite time, i.e., it is possible to determine a time constant \(T_o\) such that
Proof
The estimation errors are defined as
Taking the derivate of \(e_1\) along system (13) yields
Similarly, one can obtain
Note that
Taking Eq. (18) into (17) along with Assumption 1, the following errors differential can be obtained
This means that the solutions of differential (19) can be grasped under the Filippov sense, and the rigorous theoretical analysis of the FDO can be discovered in [40]. Then, Lemma 2 is proved. \(\square \)
Remark 3
FDO is based on the theory of Arie Levant’s differentiator [33], and the rigorous stability analysis of the FDO can be found in [33]. Levant has provided a detailed guideline for selecting observer parameters. Different from the observers such as ESO [31], NDO [37], etc., the estimation error of disturbance can be guaranteed to gather to the equilibrium point within finite time rather than asymptotically; meanwhile, the adopted FDO provides faster convergence rate of large initial error. In the following, the differentiator will also be used to filter the high-frequency control.
3.2.2 Design of FDOB-CTSMC
A new FDO-based integral terminal sliding surface is given below to drive the lateral error to zero within a finite time:
with \(\beta _i,\,\,\alpha _i\,\,\left( i=1,2 \right) \) denote positive control parameters, and \(\alpha _i\) are determined to satisfy
A composite terminal sliding mode controller is constructed as follows:
where
By substituting the expression of \(\dot{\theta }_e\left( t \right) \) in (6) and the controller (22) into the sliding manifold (20), we have
Based on (24), the following composite terminal sliding mode controller can be constructed for system (6)
where \(\beta ^{'}>\phi _2+\eta , \eta >0\) is a constant.
Theorem 2
Under the FDOB-CTSMC (25), the lateral deviation in the system (6) will converge to zero along the terminal sliding manifold (20) within a finite time.
Proof
The Lyapunov function is chosen as \(V_s=\frac{1}{2}s^2\), such that
According to (26), one can obtain
Based on Lemma 1, the sliding variable s can reach sliding manifold (20) within a finite-time \(T_s\). Once the desired sliding mode occurs, the new state variables are defined as \(\tilde{e}_d\left( t \right) =e_d,\) and \(\tilde{\theta }_e\left( t \right) =\theta _e+z_2\). Then, the motion trajectories of the new states can be expressed as
In the next, we will show that there will be no finite-time escape phenomenon in a finite-time \(T_e=\max \left\{ T_s,\,\,T_o \right\} \). A finite-time bounded (FTB) function is constructed for (28) as
Taking the derivate of (29) yields
By using inequality scaling and note that \(\left| \tilde{e}_d\left( t \right) \right| ^{\alpha _1}<1+\left| \tilde{e}_d\left( t \right) \right| \), for \(0<\alpha _1<1\), one can obtain
where \(K_{\max }=2+\beta _1+\beta _2, L_{\max }=\frac{1}{2}\max \{ ( \beta _1+\beta _2 ) ^2+z_2^2+\dot{s}^2+ \widetilde{\theta }_{e}^{2}(t) \} \). It can be conclude that the states \(\tilde{e}_d\left( t \right) ,\,\,\tilde{\theta }_e\left( t \right) \) will not escape in a finite-time \(T_e\). According to (27) and Lemma 2, we have \(e_1=0\) and \(\dot{s}=0\) after \(T_e\), then the system (28) will reduce as
according to Proposition 8.1 and its proof given in [41], the lateral deviation will converge to zero in a finite time. This completes the proof. \(\square \)
It should be noted in (25) that the controller contains the discontinuous signum function, controller chattering in FDOB-CTSMC remains severe. Inspired by Uktin’s work in [36], this research adopts and develops an adaptive control method that can greatly reduce controller chattering.
3.3 Design of FDOB-CATSMC lateral path tracking controller
In order to avoid the above questions, the FDOB-CATSMC scheme is proposed in this subsection. The FDOB-CATSMC is made up of the following components: finite-time disturbance observer; terminal sliding mode controller, and an adaptive control law. The control frame sketch of the FDOB-CATSMC is shown in Fig. 2.
3.3.1 Equivalent control design
According to the definition of equivalent control theory [36], the equivalent control \(\tilde{\omega }_s\left( t \right) \) is
Due to the fact that the lumped matched disturbance \(f_2\) is unknown, (33) is often regarded as an abstract concept that cannot be implemented practically. After the system state variables have reached the sliding surface, the actual control (25) and the equivalent control (33) are equivalent. Therefore, by filtering the high-frequency control, it is possible to obtain that
where \(\left[ \text {sign}\left( s \right) \right] _{av}\) denotes the evenness signal of \(\text {sign}\left( s \right) \).
Obviously, as indicated by the definition of signum function, \(\text {sign}\left( s \right) \) varies in the range \(\left[ -1,1 \right] \). Hence, we can conclude that its evenness value also changes between \(\left[ -1,1 \right] \). n addition, we have the following assumption:
Assumption 2
The two times derivative of variable \(\left[ \text {sign}\left( s \right) \right] _{av}\) is assumed to be bounded, i.e., \(\frac{\mathrm{d}^2}{\mathrm{d}t^2}\left[ \text {sign}\left( s \right) \right] _{av}\le \varGamma ,\,\,\varGamma >0\) is a positive constant.
3.3.2 High-frequency signal filter design
Arie Levant’s differentiator from [36] is used to derive the evenness signal of \(\left[ \text {sign}\left( s \right) \right] _{av}\), and the sliding mode-based filter is developed as
where \(\varOmega _i,\,\,i=0,1,2\) are positive parameters to be designed, \(\upsilon _{-1}\) denotes the auxiliary internal variable, \(\upsilon _0\) and \(\upsilon _1\) are the estimation of \(\left[ \text {sign}\left( s \right) \right] _{av}\) and \(\frac{\mathrm{d}^2}{\mathrm{d}t^2}\left[ \text {sign}\left( s \right) \right] _{av}\), respectively.
Lemma 3
The output \(\upsilon _0\) of the high-frequency signal filter (35) can follow up the evenness signal \(\left[ \text {sign}\left( s \right) \right] _{av}\) .
Proof
Defining the following variables
with \(\varPsi \) being the auxiliary variable, which is generated by
According to Assumption 2, it can be easy to find \(| \text {sign}( s )\) \(-[ \text {sign}( s ) ] _{av} |\le \varepsilon _1\), \(\varepsilon _1>0\) with being a positive constant.
By integrating Eq. (37), we have
which also yields \(\left| \varphi \varPsi \right| \le \varepsilon _1,\,\,\left| \varPsi \right| \le \varepsilon _2\) with \(\varepsilon _2=\varepsilon _1\varphi ^{-1}\).
Taking the derivate of (36) along with (35), the following differential holds:
By defining \(\varepsilon =\max \left\{ \left( \frac{\varepsilon _2}{\varGamma } \right) ^{\frac{1}{3}},\,\,\left( \frac{\varepsilon _1}{\varGamma } \right) ^{\frac{1}{2}} \right\} \), which implies that \(\varepsilon _1\le \varGamma \varepsilon ^2,\,\,\varepsilon _2\le \varGamma \varepsilon ^3\).
According to the Filippov theory [40], we have
It can conclude that Eq. (40) is homogeneous of the degree \(-1\) with the weight \( \left( \text {deg}\,\,q_{-1},\,\,\text {deg}\,\,q_0,\,\,\text {deg}\,\,q_1 \right) =\left( 3,2,1 \right) . \) According to Theorem 1 in the work of [40,41,42,43,44], one can obtain that the following accuracy holds:
where \(\mu _0\) is a constant depends on \(\varOmega _i,\,\,i=0,1,2\). The inequality (41) means that the output variable \(\upsilon _0\) will converge to \(\left[ \text {sign}\left( s \right) \right] _{av}\). Then, we complete the proof. \(\square \)
3.3.3 Design of FDOB-CATSMC
Noting that the control gain \(\beta ^{'}\) in (25) is occasionally larger than the upper bound of the matched disturbance \(f_2\), the severe chattering problem cannot be avoided. Due to the time-varying operating environment, road surface, driving skills, etc., it is difficult to determine the upper limt of the disturbance. The fixed constant gain \(\beta ^{'}\) will be replaced with the following variable gain \(\beta \left( t \right) \) in the subsequent step. The FDOB-CATSMC is designed as follows:
where \(\xi >\frac{\phi _2}{h\beta ^-}\) and \(\varTheta >\xi \beta ^+\); \(\beta ^->0\) and \(\beta ^+>\phi _2\) denote the bottom and upper limit bounds of the variable high gain \(\beta \left( t \right) \), we define \(\vartheta \in \left( 0,1 \right) \).
Theorem 3
Under the FDOB-CATSMC (42), the lateral deviation in the system (6) will converge to zero along the terminal sliding manifold (20) within a finite time. Meanwhile, the variagle high gain \(\beta \left( t \right) \) generated by (42) gathers to \(\frac{\left| f_2 \right| }{\vartheta }\) within a finite time, and it is limited between \(\left[ \beta ^-,\,\,\beta ^+ \right] \) to look for the best magnitude.
Proof
Primarily, we will prove the related properties of the adaptive gain \(\beta \left( t \right) \). According to the definition of equivalent control, we have the following relationship:
The key concept of the adaptive technology is that the evenness value of the high frequency should be as close to 1 once the system state reaches the sliding surface. Hence, \(\beta \left( t \right) =\frac{f_2}{\left[ \text {sign}\left( s \right) \right] _{av}}>f_2\), the variable controller gain \(\beta \left( t \right) \) could approach \(f_2\).
Choosing the Lyapunov function as
Taking the derivate of (44) with (42) and (43) yields
It is evident that through the pursuit of dynamic gain, one has
Using Assumption 2 and (46), (45) can be transformed into
where \(p=\frac{\sqrt{2}\left( \vartheta \beta ^-\xi -f_2 \right) }{\beta ^+}>0\). Based on Lemma 1, the variable \(\sigma \) will gather to the equilibrium point within a finite time, i.e., the evenness value of the high frequency will be close to \(\vartheta \) within a finite time. Finally, the dynamic adaptive gain \(\beta \left( t \right) \) can converge to \(\frac{\left| f_2 \right| }{\vartheta }\).
According to the adaptive law (42), the dynamic adaptive gain \(\beta \left( t \right) \) would not escape from the range \(\left[ \beta ^-,\,\,\beta ^+ \right] \). In fact, if \(\beta \left( t \right) \) increases to its maximum value \(\beta ^+\), one can obtain
with \(\sigma \left( t \right) >0\) and \(\varTheta >\xi \beta ^+\), hence \(\dot{\beta }\left( t \right) \) would be negative, similarly, \(\beta \left( t \right) \) would not lower than \(\beta ^-\). Hence, the variable control gain \(\beta \left( t \right) \) will converges to \(\frac{\left| f_2 \right| }{\vartheta }\) in a finite time, and it is constrained in the region \(\left[ \beta ^-,\,\,\beta ^+ \right] \) to search for the minimum magnitude. It should be pointed out that the prior upper bound information of the unknown total disturbance \(f_1\) can be avoided to be exactly known by choosing a very large \(\beta ^+\), which will not affect the control performance.
Next, the finite-time convergence of the sliding variable and the lateral deviation will be proved. It should be noted that in (25) that \(\beta ^{'}>\phi _2+\eta ,\,\,\eta >0\). The constant \(\eta \) is only used to guarantee finite-time stability. Defining \(\tilde{f}_2=f_2+\eta \), indeed, \(\tilde{f}_2\) and \(f_2\) are essentially the same. Hence, it is reasonable to obtain the dynamic variable gain \(\beta \left( t \right) \) to track \(\tilde{f}_2\) in a finite time.
Choosing the Lyapunov function as
Based on (42), taking the derivate of (49) yields
According to (47) and (42), the inequality (50) can be further scaled into
Based on Lemma 1, the sliding variable s will converge to the sliding manifold (20) in a finite time. Then, the finite-time convergence proof of lateral deviation resembles (28)\(\sim \)(32). This completes the proof. \(\square \)
4 Simulation and discussion
In this section, to verify the effectiveness of the proposed controller, comparative numerical simulations were conducted. The simulation is carried out by the Euler method, and the sampling time is set as 0.0001 s, the simulation time is 10 s. The desired path is chosen as a line \(y_v=x_v,\,\,\theta ^*=\frac{\pi }{4}\), as shown in Fig. 3. The set liner velocity of the farm vehicle is set as \(v_s=1\,\mathrm{m/s}\), and the initial states are selected as
In order to compare fairly and comprehensively, three cases under different disturbances are set.
The parameters of FDO (13) are chosen as \(L_1=-4.5\cdot 2^{\frac{1}{3}}\), \(L_2=-4.5\cdot 2^{\frac{1}{2}}\) and \(L_3=-3\). The ESO proposed in [21] was used to make the comparison. As shown in Fig. 4, high-accuracy tracking of disturbances pertaining to the farm vehicle can be observed by the FDO within 0.7 s. The mismatched disturbance tracking performance of the FDO is better than the ESO; meanwhile, the adopted FDO provides faster convergence rate of large initial error.
The parameters of the adaptive law (42) are set as \(\vartheta =0.999,\,\,\xi =1.3\), \(\beta ^+=15,\,\,\beta ^-=0.001\), \(\varTheta =30\). The parameters of (35) are \(\varGamma =250\), \(\varOmega _0=12\), and \(\,\,\varOmega _1=17,\,\,\varOmega _2=8\). Figure 5 depicts the trajectories of the variable control gain \(\beta \left( t \right) \). It can be seen that \(\beta \left( t \right) \) tends to but larger than the lumped matched disturbance \(f_2\). The controller parameters of different controllers are shown in Table 2.
Within the line tracking task of agricultural vehicles with unknown disturbances, the proposed FDOB-CATSMC strategy allows the vehicle to reach the target inspection path in less than 1 s, as shown in Fig. 6. By comparing Fig. 6, we can see that the FOSM technique struggles to trace the required trajectory, particularly in the presence of the fast time-varying mismatched disturbance, as in Case 3. The steady error in FOSM is about 0.045 m.
Figure 7 depicts the history of the control signals for three different controllers. Benefits from the adaptive law, the chattering in FDOB-CATSMC is less than that in FOSM and FDOB-CATSMC. As a result, the proposed FDOB-CATSMC is effective in reducing chattering. Meanwhile, the proposed method maintains the mismatched disturbance rejection ability.
Remark 4
In practice, one solution to reduce the chattering existing in the traditional sliding mode controller is to replace the sign function with a saturation function, but the price paid is that the robustness of the resulting closed-loop system will be significantly weakened. As shown in Fig. 7, it is reasonable to claim that the FDOB-CATSMC can significantly reduce the chattering issue and also maintain the robustness.
5 Conclusion
In this paper, a composite adaptive terminal sliding mode controller for farm vehicles with unknown disturbances is constructed. The FDO is used to estimate the lumped mismatched disturbance, which is induced by model nonlinearity, and external disturbances. The integral terminal sliding surface is built by using the estimated value of disturbance. To suppress the chattering problem appearing in FOSM and FDOB-CTSMC, an adaptive control is used to search for the best value of the time-varying control gain, resulting in the least amount of chattering of the SMC. Numerical simulation results have proven the effectiveness and adaptability of the proposed FDOB-CATSMC.
Data availability
The datasets generated during and/or analyzed current study are available from the corresponding author on reasonable request.
References
Bochtis, D.D., Sørensen, C.G., Busato, P.: Advances in agricultural machinery management: a review. Biosyst. Eng. 126, 69–81 (2014)
Backman, J., Oksanen, T., Visala, A.: Navigation system for agricultural machines: nonlinear model predictive path tracking. Comput. Electron. Agric. 82, 32–43 (2012)
Cheein, F.A.A., Carelli, R.: Agricultural robotics: unmanned robotic service units in agricultural tasks. IEEE Ind. Electron. Mag. 7(3), 48–58 (2013)
Cisternas, I., Velásquez, I., Caro, A., Rodríguez, A.: Systematic literature review of implementations of precision agriculture. Comput. Electron. Agric. 176, 105626 (2020)
Thuilot, B., Cariou, C., Martinet, P., Berducat, M.: Automatic guidance of a farm tractor relying on a single CP-DGPS. Auton. Robot. 13(1), 53–71 (2002)
Vis, I.F.: Survey of research in the design and control of automated guided vehicle systems. Eur. J. Oper. Res. 170(3), 677–709 (2006)
Aguiar, A.P., Hespanha, J.P.: Trajectory-tracking and path-following of underactuated autonomous vehicles with parametric modeling uncertainty. IEEE Trans. Autom. Control 52(8), 1363–1379 (2007)
Pradalier, C., Usher, K.: Robust trajectory tracking for a reversing tractor trailer. J. Field Rob. 25(6–7), 378–399 (2008)
Li, M., Imou, K., Wakabayashi, K., Yokoyama, S.: Review of research on agricultural vehicle autonomous guidance. Int. J. Agric. Biol. Eng. 2(3), 1–16 (2009)
Soudbakhsh, D., Eskandarian, A.: A collision avoidance steering controller using linear quadratic regulator. SAE Technical Paper. No. 2010-01-0459 (2010)
Ding, Y., Wang, L., Li, Y., Li, D.: Model predictive control and its application in agriculture: a review. Comput. Electron. Agric. 151, 104–117 (2018)
Falcone, P., Borrelli, F., Asgari, J., Tseng, H.E., Hrovat, D.: Predictive active steering control for autonomous vehicle systems. IEEE Trans. Control Syst. Technol. 15(3), 566–580 (2007)
Yue, M., Hou, X., Zhao, X., Wu, X.: Robust tube-based model predictive control for lane change maneuver of tractor-trailer vehicles based on a polynomial trajectory. IEEE Trans. Syst. Man Cybern. Syst. 50(12), 5180–5188 (2018)
Astolfi, A., Bolzern, P., Locatelli, A.: Path-tracking of a tractor-trailer vehicle along rectilinear and circular paths: a Lyapunov-based approach. IEEE Trans. Robot. Auton. 20(1), 154–60 (2004)
Khalaji, A.K.: PID-based target tracking control of a tractor-trailer mobile robot. Proc. Inst. Mech. Eng. Part C J. Mech. Eng. Sci. 233(13), 4776–4787 (2019)
Yang, Y., Li, Y., Wen, X., Zhang, G., Ma, Q., Cheng, S., Chen, L.: An optimal goal point determination algorithm for automatic navigation of agricultural machinery: improving the tracking accuracy of the Pure Pursuit algorithm. Comput. Electron. Agric. 194, 106760 (2022)
Lenain, R., Thuilot, B., Cariou, C., Martinet, P.: Mixed kinematic and dynamic sideslip angle observer for accurate control of fast off-road mobile robots. J. Field Rob. 27(2), 181–196 (2010)
Lenain, R., Thuilot, B., Cariou, C., Bouton, N., Berducat, M.: High accuracy path tracking for vehicles in presence of sliding: application to farm vehicle automatic guidance for agricultural tasks. Auton. Robot. 21(1), 79–97 (2006)
Wang, Y., Gao, S., Wang, Y., Wang, P., Zhou, Y., Xu, Y.: Robust trajectory tracking control for autonomous vehicle subject to velocity-varying and uncertain lateral disturbance. Arch. Transp. 57 (2021)
Taghia, J., Wang, X., Lam, S., Katupitiya, J.: A sliding mode controller with a nonlinear disturbance observer for a farm vehicle operating in the presence of wheel slip. Auton. Robot. 41(1), 71–88 (2017)
Chen, S., Xue, W., Lin, Z., Huang, Y.: On active disturbance rejection control for path following of automated guided vehicle with uncertain velocities. In: ACC, pp. 2446–2451 (2019)
Chu, Z., Sun, Y., Wu, C., Sepehri, N.: Active disturbance rejection control applied to automated steering for lane keeping in autonomous vehicles. Control Eng. Pract. 74, 13–21 (2018)
Ding, S., Zheng, W.X., Sun, J., Wang, J.: Second-order sliding-mode controller design and its implementation for buck converters. IEEE Trans. Ind. Inf. 14(5), 1990–2000 (2017)
Ding, S., Liu, L., Zheng, W.X.: Sliding mode direct yaw-moment control design for in-wheel electric vehicles. IEEE Trans. Ind. Electron. 64(8), 6752–6762 (2017)
Hou, Q., Ding, S.: Finite-time extended state observer based super-twisting sliding mode controller for PMSM drives with inertia identification. IEEE Trans. Transp. Electrif. (2021). https://doi.org/10.1109/TTE.2021.3123646
Wang, L., Mei, K., Ding, S.: Fixed-time SOSM controller design subject to an asymmetric output constraint. J. Franklin Inst. 358(15), 7485–7506 (2021)
Yang, J., Li, S., Su, J., Yu, X.: Continuous nonsingular terminal sliding mode control for systems with mismatched disturbances. Automatica 49(7), 2287–2291 (2013)
Sun, H., Li, S., Sun, C.: Finite time integral sliding mode control of hypersonic vehicles. Nonlinear Dyn. 73(1), 229–244 (2013)
Yang, J., Su, J., Li, S., Yu, X.: High-order mismatched disturbance compensation for motion control systems via a continuous dynamic sliding-mode approach. IEEE Trans. Ind. Inf. 10(1), 604–614 (2013)
Levant, A.: Sliding order and sliding accuracy in sliding mode control. Int. J. Control 58(6), 1247–1263 (1993)
Wu, Y., Wang, L., Zhang, J., Li, F.: Path following control of autonomous ground vehicle based on nonsingular terminal sliding mode and active disturbance rejection control. IEEE Trans. Veh. Technol. 68(7), 6379–6390 (2019)
Nayl, T., Nikolakopoulos, G., Gustafsson, T., Kominiak, D., Nyberg, R.: Design and experimental evaluation of a novel sliding mode controller for an articulated vehicle. Rob. Auton. Syst. 103, 213–221 (2018)
Levant, A.: Higher-order sliding modes, differentiation and output-feedback control. Int. J. Control 76(9–10), 924–941 (2003)
Ding, S., Mei, K., Li, S.: A new second-order sliding mode and its application to nonlinear constrained systems. IEEE Trans. Autom. Control 64(6), 2545–2552 (2018)
Ding, C., Ding, S., Wei, X., Mei, K.: Composite SOSM controller for path tracking control of agricultural tractors subject to wheel slip. ISA Trans. (2022). https://doi.org/10.1016/j.tsatra.2022.03.019
Utkin, V.I., Poznyak, A.S.: Adaptive sliding mode control with application to super-twist algorithm: equivalent control method. Automatica 49(1), 39–47 (2013)
Yang, J., Li, S., Yu, X.: Sliding-mode control for systems with mismatched uncertainties via a disturbance observer. IEEE Trans. Ind. Electron. 60(1), 160–169 (2012)
Aguiar, A.P., Hespanha, J.P., Kokotović, P.V.: Performance limitations in reference tracking and path following for nonlinear systems. Automatica 44(3), 598–160 (2008)
Yu, S., Yu, X., Shirinzadeh, B., Man, Z.: Continuous finite-time control for robotic manipulators with terminal sliding mode. Automatica 41(11), 1957–1964 (2005)
Filippov, A.F.: Differential Equations with Discontinuous Righthand Sides: Control Systems, vol. 18. Springer, Berlin
Bhat, S.P., Bernstein, D.S.: Finite-time stability of continuous autonomous systems. SIAM J. Control. Optim. 38(3), 751–766 (2000)
Levant, A., Yu, X.: Sliding-mode-based differentiation and filtering. IEEE Trans. Autom. Control 63(9), 3061–3067 (2018)
Du, H., Yu, X., Chen, M.Z., Li, S.: Chattering-free discrete-time sliding mode control. Automatica 68, 87–91 (2016)
Isidori, A.: Nonlinear Control Systems: An Introduction. Springer, Berlin (1985)
Funding
This work is supported by the National Key Research and Development Program under Grant 2019YFB1312302, the Key Research and Development of Jiangsu Province under Grant BE2020327, the Key Research and Development of Jiangsu Province under Grant BE2021313.
Author information
Authors and Affiliations
Corresponding author
Ethics declarations
Conflict of interest
The authors declare that they have no potential conflicts of interest.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Springer Nature or its licensor holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.
Springer Nature or its licensor holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.
About this article
Cite this article
Ji, X., Wei, X., Wang, A. et al. A novel composite adaptive terminal sliding mode controller for farm vehicles lateral path tracking control. Nonlinear Dyn 110, 2415–2428 (2022). https://doi.org/10.1007/s11071-022-07730-x
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s11071-022-07730-x