Switched Vector Field-based Guidance for General Reference Path Following in Planar Environment
Abstract
Reference path following is a key component in the functioning of almost all engineered autonomous agents. Among several path following guidance methods in existing literature, vector-field-based guidance approach has got wide attention because of its simplicity and guarantee of stability under a broad class of scenarios. However, the usage of same cross-track-error-dependent structure of desired vector field in most of the existing literature irrespective of instantaneous cross-track error and course angle of unmanned vehicle makes it quite restrictive in attaining faster convergence and also leads to infeasibly high turn rate command for many scenarios. To this end, this paper presents a novel switched vector field-based guidance for following a general reference path, in which the structure of the desired vector field depends on instantaneous cross-track-error and vehicle’s course angle. While the developed method ensures faster convergence, it also ensures that the guidance command always stays within a realistic threshold satisfying its curvature constraint, thus making it more real-life implementable for autonomous vehicles with kino-dynamic constraints. Theoretical analysis for convergence of the developed guidance scheme is presented. Possibilities of undesirable chattering at phase transitions are also eliminated. Numerical simulation studies are presented to validate the satisfactory performance of the developed algorithm.
I INTRODUCTION
With the steady advances in technologies related to autonomy, unmanned vehicles (UxVs) have seen large-scale adoption in different civilian and military applications. Capability of autonomously following pre-defined reference paths is a key component in most of these scenarios.
In existing literature, path following problem has been addressed in three broad ways - control theoretic, guidance theoretic and vector field-based methods [1]. Among control-theoretic methods, linear controllers like proportional–integral–derivative (PID) [2] and optimal control-based methods [3], [4] on linearized geometries have been presented for developing path following control schemes. However, these methods majorly rely on small deviation from nominal assumption that is valid for sufficiently small heading error or cross-track error geometries. Lyapunov-based nonlinear controllers have also been developed in [5], [6] for regulation of path following error. While these nonlinear control techniques possess guaranteed stability and reliable tracking, the guidance commands are complicated, model-dependent and also depend on the magnitude of error [7], which was resolved in differential geometry-based path following guidance formulations in [7], [8]. However, their convergence proofs were restricted to constant-curvature planar paths. On the other hand, guidance-theoretic path following methods are model-independent, simple and easy to implement. Some of these schemes involve Pure pursuit (PP) [9], [10], line-of-sight (LOSG) guidance [11], trajectory shaping guidance [12], combination of PP and LOSG [13]. Apart from these, A Proportional Navigation (PN)-resembling guidance was devised in [14] for following a virtual target at a fixed-look-ahead distance on a reference path (straight line or circular or perturbed path), while another PN-based guidance was formulated in [15] for following a virtual target at a fixed look-ahead direction. Apart from these, Dubins curve-based guidance scheme for following an optimal feasible path in three-dimensional space was presented in [16]. Among all these nonlinear formulations, the look-ahead-based path following guidance [14] has got popularity because of its simplicity and ease in application, asymptotic stability and robustness. However, its drawback of constant look-ahead distance makes it restrictive for realistic path following applications. To this end, a radius of reference path curvature-dependent variable look-ahead distance guidance was presented in [17]. The major limitation of the look-ahead-based guidance schemes is that the initial position of the UxV needs to be inside the range of specified look-ahead distance from the reference path, thus necessitating an additional mid-course guidance law if the initial position is outside of the look-ahead distance.
In this context, Vector field-based methods [18], are gainfully leveraged due to their low cross-track error and low control effort compared to other existing path following algorithms [1]. Following this approach, the desired course angle of the UxV is constructed using a vector field, whose integral curves asymptotically direct the UxV to the pre-determined reference path. Stability analysis of the vector field-based path-following method for reference straight and circular paths was presented in [18], while this method was extended in [19] to following a general reference path with small straight line approximation. In [20], a notion of circular attractor Lyapunov function was defined to generate the vector field for a reference path following. Distance-based application of irrotational and rotational parts of a vector field was utilized in [21] for path following in 3-D. A general method for creating the vector field needed for navigation in n-dimensional space was presented in [22], singularity problem of which was subsequently addressed in [23].
However, in most of the vector field-based methods in existing literature, the field is defined as a function of only cross-track error, thus making the vector field form same irrespective of the magnitude of cross-track error. This significantly limits the possibility of enhanced convergence to the reference path. Moreover, in these formulations, as the cross-track error approaches to infinity, the commanded desired heading angle approaches to a constant, which often leads to kino-dynamically infeasible high turn rate command if the course angle error is very high. Additionally, curvature constraints play a pivotal role in achieving precise trajectory tracking and optimizing vehicle performance while taking real-world limitations into account [24]. To address all these considerations, in this paper, a general reference path following guidance scheme for planar applications is presented based on a novel formulation of switched vector field, in which its dependence on cross-track error facilitates in augmented convergence of the developed guidance scheme, while its dependence on UAV course ensures that the turn rate command remains within a kino-dynamically feasible threshold. Stability analysis for finite time convergence by the developed guidance strategy is given. Thus, attaining a faster path following while maintaining the guidance command within feasible threshold value forms the salient feature of the developed guidance scheme.
The rest of this paper is organized as follows: Section II defines the problem. Section III introduces different vector fields and develops as well as analyzes a novel guidance strategy for a following general reference path. Section III-D delves into the curvature limitations associated with general reference path following. The proposed guidance law is then validated using numerical simulations in Section IV. Finally, Section V concludes the overall guidance algorithm.
II Problem Definition
II-A Navigation Dynamics
Consider the problem of following a reference path as shown in Fig. 1. The navigational dynamics of a constant speed UAV flying at a constant altitude can be stated as,
(1) |
Here, denotes the UAV’s position w.r.t. inertial reference frame . Its ground speed and course angle are given as and , respectively, where , denote the UAV airspeed and wind speed, respectively. Subscripts and denote along and directions. Incorporation of ground speed () and course of the UAV () in (1) ensures that the wind-effect is implicitly factored in [18]. The UAV’s guidance command is given by the turn rate (), where is a positive constant, and represents the input course command generated by the guidance law for the UAV to follow a desired general path with time-efficiency, turn rate feasibility and path curvature constraint.
II-B Definitions Related to Reference Path
In this paper, the closest point on the reference path from the UAV’s current position is considered as the reference point . And, the distance from to , represents the cross-track error , where, represents the side of the reference path the UAV is lying on. For example, in Fig. 1, as the UAV is on right side of the reference path. The tangent vector to the path at is denoted as , which is perpendicular to . Here,
(2) |
and, is the angle between and -axis.
III Guidance for General Reference Path Following
In this section, a guidance strategy is formulated for an UAV to follow a general reference path based on a novel switched vector field-based method leading to enhanced performance in terms of path following time, while also satisfying feasible turn rate and path curvature constraints.
III-A Vector Field Description
III-A1 Dependence of Vector Field on Cross-track Error
The vector field should be such that when the UAV is far away from the desired path (large ), the desired course is directed towards the path with a constant course angle , and as approaches zero, the desired course aligns with the desired path. To achieve this, for general reference path following, the desired vector field is considered as follows.
(3) |
where, and is an integer, is a positive constant that affects the rate of transition from to while guiding the UAV to reach the desired path asymptotically. Note that the vector field considered in [18], [19] is a special Case of Eq. (3) with . When the UAV is able to follow the vector field accurately, that is , from (2),
Note that for higher value of , when is large, is also higher thus enabling the UAV to come closer to the desired path smoothly at a faster rate. But, when is very small, say is within the interval (shown as in Fig. 2(a)), is highest for . Then, cross-track error-dependent switching of vector field could be considered at to ensure faster convergence. Now, for ,
Here, as increases, also increases for large , which in turn demands high turn rate of the UAV. This is illustrated in Fig. 2(b). For , turn rate command becomes excessively high, which is often infeasible (see , , and , , points in Fig. 2(b)).
Thus, to mitigate these issues while also deriving the advantage of both the formulations of with and , a switching mechanism is considered in the vector field formulation based on whether is greater or less than , which ensures the UAV to converge with the desired path smoothly at a faster convergence rate without requiring infeasibly high turn rate. Thus, is considered for , and , else. In order to attain a continuous profile of , the convergence rate controlling parameters and are so chosen that at , the is same for both and . This implies that . Thus, the switched vector field based on cross-track error is expressed in terms of the desired UAV course as,
(4) |
Note that following (4), approaches to and as approaches and zero, respectively.
III-A2 Dependence on Instantaneous UAV Course Angle ()
When is very high, as illustrated in Fig. 3, then the generated guidance command also becomes very high. This problem becomes more severe when as more aggressive turn rate command is generated by using the formulation of with than that with . In order to get rid of this problem, also needs to be incorporated in the formulation of . Hence, the switched vector field, based on current course angle becomes,
(5) |
where, is as given in (4). Note from Fig. 3 that the selection of in (5) above leads to less turn rate command than in (4) by decreasing for . This, in effect, helps in ensuring that the commanded turn rate is within the upper threshold that arises from kino-dynamic constraints of a real unmanned vehicle.
III-B Overall Guidance Strategy
Based on the discussion in Section III-A, the overall structure of the novel switched vector field is presented in terms of desired course angle expressed as a function of both cross-track error and course angle of the UAV as,
(6) | |||||
(7) | |||||
(8) |
This desired vector field can be followed using the guidance command in (1), where the commanded UAV course is:
(9) | |||||
(10) | |||||
(11) |
where, . And, m, n are odd and co-prime integers such that . And, , where . Here, and () control the shape of the trajectories onto the sliding surface .
III-C Convergence Analysis
Consider and the scenario . The convergence analysis for the path following engagement geometries mentioned in (9)-(11) is given below. The analysis for scenario would follow in similar way.
III-C1 Case - 1 and
In this Case, the desired vector field in terms of is as given in (6), and the commanded course angle as mentioned in (9). For this geometry, the course error is guaranteed to decrease to zero in finite time as proved below.
Proposition 1
Proof:
Following from (1) and considering a Lyapunov candidate function .
(12) |
Considering as in (6) for Case - 1, we obtain,
(13) |
Then, applying as in (9), from (12), (13), it follows that, in Case-1, where ,
(14) |
Here, for odd and co-prime with , has one real solution with same sign as , which implies from (14) that monotonically decreases and converges to zero in finite time [25]. This completes the proof of Proposition 1. ∎
III-C2 Case - 2 and
Proposition 1 guarantees finite time completion of Case-1 geometry, leading to Case-2 geometry, for which and are switched to (7) and (10), respectively. Recall from Remark 1 that , therefore, increases at the time of phase transition from Case - 1 to Case - 2. However, as is shown to monotonically decrease in this case, crosses at some finite time, and also decreases then onward.
Proposition 2
Proof:
Following from (1) and considering a Lyapunov candidate function ,
(15) |
From (7), for Case - 2 geometry we obtain,
(16) |
Then, applying the commanded course as presented in (10), it follows from (15) and (16) that for Case-2,
(17) |
Therefore, it is evident that monotonically decreases and finally converges to zero in finite time [26]. ∎
However, in practice, the function in (10) leads to chattering in the control output [26]. To mitigate this, the function can be replaced with function. Therefore, the updated command is given as
(18) |
where, is defined as if , and , else. And, sets the boundary region width around the sliding surface to reduce chattering in .
Remark 2
Even if Case-2 is initiated with , as monotonically decreases to zero in finite time, as shown in Proposition 2, and as for (refer to (4)), also lies in the interval as . Besides, as is continuous within the time interval the geometry lies in Case - 2, by intermediate value theorem, is guaranteed to cross zero in a finite time. And, that time onward, implying monotonically decreasing .
Remark 3
From (14), at as for in Case - 1. Hence, if the switching of vector field at the transition from Case - 1 to Case - 2 takes place at , there is a possibility of undesirable chattering at the transition. To avoid that, this switching may be done at for some small positive , when for some small positive . Note that since and remain positive and negative, respectively, both at (follows Case - 1) and at the beginning of Case - 2 geometry after the transition, the switching at would maintain the same convergence pattern, while also ensuring no undesired chattering during the switching of vector field between Case -1 and Case - 2 geometries.
Proposition 3
III-C3 Case - 3 )
Propositions 1, 2 and 3, guaranteed the path following guidance switches to this Case within finite time. Consequently, and are switched to (8) and (11), respectively. Following the same steps as in Case - 2 in Section III-C2, the following result can be shown.
Proposition 4
Remark 4
The transition from Case - 2 to Case -3 takes place at . Also, both at the end of Case - 2 and at the beginning of Case -3 geometries, both and are negative. These eliminate the possibility of chattering and any degradation of convergence performance during the switching of vector field from Case -2 to Case - 3.
III-C4 Final Result
Theorem 1
III-D Curvature Constraints
Convergence analysis in Section III-C shows that convergence rate of to depends on , and (for ), as indicated by (14), (17) and (19), respectively. These parameters also affect the curvature of the UAV’s path as may be noted from (1), (9)-(11). Accordingly, this section outlines conditions on these parameters to ensure kino-dynamic feasibility of the UAV’s commanded path. For that, considering , the curvature variation is:
(20) |
For , using from (8) and ,
(21) |
Note that does not have dependence on . Thus, the condition for maximum value of is:
(22) |
From (22), for , we obtain that at . Similarly, recall that for , , and is given in (6) and (7). Then, at , . Now, for , from (20),
(23) |
where, is the maximum allowable curvature in the UAV’s path. Then, from (23),
(24) |
As, dependent on the , and as discussed above, (24) can be rewritten as,
(25) |
Thus, for given (UAV’s turn rate constraint), (maximum path curvature) and (UAV speed), the overall switched vector field ((6)-(8)) can be designed by suitably selecting and that satisfies (25). This can be followed by the commanded course angles ((9)-(11)) with suitable selection of and satisfying the constraint for effectively following a general reference path without any undesirable chattering at phase transitions, as explained in Theorem 1, Remarks 3 and 4.
IV Simulation Results
In this section, the path following guidance strategy presented in Section III-B is validated using numerical simulations performed in MATLAB (R2023a) environment. The parameters considered for the simulations are as follow. Constant UAV speed () of m/s is considered for all scenarios. And, , s-1, , rad, , , m, , . In practice, can be approximated using tangents to the path as , where is the tangent to the path in the previous time step.
Fig. 4 illustrates a numerical example of following a reference sinusoidal path (, where and ) with no wind consideration, that is , for better understanding of the convergence analysis given above. As can be seen in Fig. 4(a), initially and also , i.e. the geometry is in Case - 1. As stated in Remark 1, increases initially as shown in Fig. 4(d). However, from Fig. 4(c), observe that monotonically decreases as discussed in proposition 1. As it reaches near zero, the 1st switching happens as shown as Switch 1 in Fig. 4. At Switch 1, following Case - 2 geometry, the vector field has , which leads to a jump in profile (see Fig. 4(c)). Then, in line with Proposition 2 for Case - 2 geometry, monotonically decreases. After the transition from Case - 1 to Case - 2, initially is still greater than zero. As a result, increases initially in Case - 2 geometry. However, as crosses , then starts decreasing (see Fig. 4(d)) as per Remark 2. As crosses in finite time (Proposition 3), Switch 2 happens, and the geometry falls in Case - 3, wherein following Proposition 4, and monotonically decrease. Besides, as mentioned in Remarks 3 and 4, no undesirable chattering is observed at the phase transitions. Now, from profile in Fig. 4(b), rad/sec, which is within kino-dynamically feasible range. This leads to RHS of (25) as /m. And for the considered reference path, rad/sec. Therefore, LHS of (25) becomes , which satisfies (25).
The developed guidance algorithm (a) is now compared with (b) vector field method [18], (c) PLOS mehtod [13], and (d) NLGL () method [14], with parameters fine tuned for better performance as follows. For method (b) and , for (c) and , and for (d) m. The initial conditions considered are m (for (a), (b) and (c)), and m(for (d)) and (for all methods). From Figs. 5(a) and 5(b), note that Methods (b) and (c) closely follow the path, but initial turn rate command is very high for method (c), and the convergence time for method (b) is high. On the other hand, method (d) has always higher cross-track error. Unlike them, the proposed switched vector field method allows the UAV to closely follow the path with feasible turn rate and low convergence time.
Total 200 random trials are next performed with m, rad, wind speed m/s, wind direction rad and control parameters same as previous simulations. The performance measures are: i) Reaching time (), ii) RMS cross track error(), iii)RMS turn rate, and iv) maximum turn rate, max(), as shown in Fig. 6. Here, is defined as the duration by which the UAV reaches a threshold distance relative to the reference path, while subsequently following a course angle sufficiently close to path’s curvature. While the NLGL method [14] exhibits low , its and are comparatively higher when compared to other methods. For PLOS method [13], is lower, but it has higher , and . Although the is almost similar for proposed switching vector field-based and the basic Vector field method [18], it is evident that the switched vector field-based approach significantly outperforms path-following methods in terms of all performance measures.
V CONCLUSIONS
This paper has presented a cross-track-error and course angle-dependent novel switching strategy in defining the desired vector field for following a general reference path. Theoretical analysis on its convergence has been presented. The developed guidance scheme has been shown to ensure faster convergence, thus leading to a lesser reaching time, while it also ensures that the guidance command does not go beyond a threshold even when the course angle error is very high. Undesirable chattering at phase transitions is also avoided. Numerical simulation studies have been presented to justify the performance of the developed guidance algorithm. Comparison studies have shown the superiority of the presented method over other existing methods.
References
- [1] P. Sujit, S. Saripalli, and J. B. Sousa, “Unmanned aerial vehicle path following: A survey and analysis of algorithms for fixed-wing unmanned aerial vehicless,” IEEE Control Syst. Magazine, vol. 34, no. 1, pp. 42–59, 2014.
- [2] I. Rhee, S. Park, and C.-K. Ryoo, “A tight path following algorithm of an uas based on pid control,” in Proc. SICE Annual Conf. 2010, 2010, pp. 1270–1273.
- [3] A. Ratnoo, P. Sujit, and M. Kothari, “Adaptive optimal path following for high wind flights,” IFAC Proc. Vol., vol. 44, no. 1, pp. 12 985–12 990, 2011.
- [4] S. He, C.-H. Lee, H.-S. Shin, and A. Tsourdos, “Minimum-effort waypoint-following guidance,” J. Guid. Control Dyn., vol. 42, no. 7, pp. 1551–1561, 2019.
- [5] C. Liu, O. McAree, and W.-H. Chen, “Path-following control for small fixed-wing unmanned aerial vehicles under wind disturbances,” Int. J. Robust Nonlinear Control, vol. 23, no. 15, pp. 1682–1698, 2013.
- [6] G. Flores, I. Lugo-Cárdenas, and R. Lozano, “A nonlinear path-following strategy for a fixed-wing mav,” in Int. Conf. Unmanned Aircr. Syst. IEEE, 2013, pp. 1014–1021.
- [7] N. Cho, Y. Kim, and S. Park, “Three-dimensional nonlinear differential geometric path-following guidance law,” J. Guid. Control Dyn., vol. 38, no. 12, pp. 2366–2385, 2015.
- [8] D. J. Gates, “Nonlinear path following method,” J. Guid. Control Dyn., vol. 33, no. 2, pp. 321–332, 2010.
- [9] E. D. Medagoda and P. W. Gibbens, “Synthetic-waypoint guidance algorithm for following a desired flight trajectory,” J. Guid. Control Dyn., vol. 33, no. 2, pp. 601–606, 2010.
- [10] J. Zhang, Q. Li, N. Cheng, and B. Liang, “Path-following control for fixed-wing unmanned aerial vehicles based on a virtual target,” Proc. Inst. Mech. Eng. G: J. Aerosp. Eng., vol. 228, no. 1, pp. 66–76, 2014.
- [11] R. Rysdyk, “Unmanned aerial vehicle path following for target observation in wind,” J. Guid. Control Dyn., vol. 29, no. 5, pp. 1092–1100, 2006.
- [12] A. Ratnoo, S. Y. Hayoun, A. Granot, and T. Shima, “Path following using trajectory shaping guidance,” J. Guid. Control Dyn., vol. 38, no. 1, pp. 106–116, 2015.
- [13] M. Kothari, I. Postlethwaite, and D.-W. Gu, “Uav path following in windy urban environments,” J. Intell. Robot. Syst, vol. 74, no. 3, pp. 1013–1028, 2014.
- [14] S. Park, J. Deyst, and J. P. How, “Performance and lyapunov stability of a nonlinear path following guidance method,” J. Guid. Control Dyn., vol. 30, no. 6, pp. 1718–1728, 2007.
- [15] N. Dhananjay and R. Kristiansen, “Guidance strategy for gradient search by multiple uavs,” in AIAA Guid. Navig. Control Conf., 2012, p. 4766.
- [16] S. Hota and D. Ghose, “Rectilinear path following in 3d space,” in Trends in Intelligent Robotics: FIRA Robot World Congress. Springer, 2010, pp. 210–217.
- [17] R. Saurav, L. D. Sohil, and S. Ghosh, “Variable l1 guidance strategy for path following of uavs,” in Int. Conf. Unmanned Aircr. Syst., 2020, pp. 1518–1524.
- [18] D. R. Nelson, D. B. Barber, T. W. McLain, and R. W. Beard, “Vector field path following for miniature air vehicles,” IEEE Trans. Robot., vol. 23, no. 3, pp. 519–529, 2007.
- [19] S. Griffiths, “Vector field approach for curved path following for miniature aerial vehicles,” in AIAA Guid. Navig. Control Conf., 2006, p. 6467.
- [20] D. A. Lawrence, E. W. Frew, and W. J. Pisano, “Lyapunov vector fields for autonomous unmanned aircraft flight control,” J. Guid. Control Dyn., vol. 31, no. 5, pp. 1220–1229, 2008.
- [21] Y. Liang and Y. Jia, “Combined vector field approach for 2d and 3d arbitrary twice differentiable curved path following with constrained uavs,” J. Intell. Robot. Syst, vol. 83, no. 1, pp. 133–160, 2016.
- [22] V. M. Goncalves, L. C. Pimenta, C. A. Maia, B. C. Dutra, and G. A. Pereira, “Vector fields for robot navigation along time-varying curves in -dimensions,” IEEE Trans. Robot., vol. 26, no. 4, pp. 647–659, 2010.
- [23] W. Yao, H. G. de Marina, B. Lin, and M. Cao, “Singularity-free guiding vector field for robot navigation,” IEEE Trans. Robot., vol. 37, no. 4, pp. 1206–1221, 2021.
- [24] A. Shivam and A. Ratnoo, “Arcsine vector field for path following guidance,” J. Guid. Control Dyn., pp. 1–12, 2023.
- [25] X. Yu, Y. Wu, and M. Zhihong, “On global stabilization of nonlinear dynamical systems,” Variable structure systems, sliding mode and nonlinear control, pp. 109–122, 1999.
- [26] Y. Shtessel, C. Edwards, L. Fridman, A. Levant et al., Sliding mode control and observation. Springer, 2014, vol. 10.