Singularity-Free Guiding Vector Field for Robot Navigation

Most of the existing path-following navigation algorithms cannot guarantee global convergence to desired paths or enable following self-intersected desired paths due to the existence of singular points where navigation algorithms return unreliable or even no solutions. One typical example arises in vector-field guided path-following (VF-PF) navigation algorithms. These algorithms are based on a vector field, and the singular points are exactly where the vector field diminishes. In this paper, we show that it is mathematically impossible for conventional VF-PF algorithms to achieve global convergence to desired paths that are self-intersected or even just simple closed (precisely, homeomorphic to the unit circle). Motivated by this new impossibility result, we propose a novel method to transform self-intersected or simple closed desired paths to non-self-intersected and unbounded (precisely, homeomorphic to the real line) counterparts in a higher-dimensional space. Corresponding to this new desired path, we construct a singularity-free guiding vector field on a higher-dimensional space. The integral curves of this new guiding vector field is thus exploited to enable global convergence to the higher-dimensional desired path, and therefore the projection of the integral curves on a lower-dimensional subspace converge to the physical (lower-dimensional) desired path. Rigorous theoretical analysis is carried out for the theoretical results using dynamical systems theory. In addition, we show both by theoretical analysis and numerical simulations that our proposed method is an extension combining conventional VF-PF algorithms and trajectory tracking algorithms. Finally, to show the practical value of our proposed approach for complex engineering systems, we conduct outdoor experiments with a fixed-wing airplane in windy environment to follow both 2D and 3D desired paths.

[1]  Timothy W. McLain,et al.  Vector Field Path Following for Miniature Air Vehicles , 2007, IEEE Transactions on Robotics.

[2]  Mandy Eberhart,et al.  Ordinary Differential Equations With Applications , 2016 .

[3]  A. Galbis,et al.  Vector Analysis Versus Vector Calculus , 2012 .

[4]  Hector Garcia de Marina,et al.  Guiding Vector Field Algorithm for a Moving Path Following Problem , 2017 .

[5]  Ramon Pérez,et al.  A Survey of Path Following Control Strategies for UAVs Focused on Quadrotors , 2019, J. Intell. Robotic Syst..

[6]  Simon Lacroix,et al.  Fleets of enduring drones to probe atmospheric phenomena with clouds , 2016 .

[7]  Kristin Ytterstad Pettersen,et al.  Integral LOS control for path following of underactuated marine surface vessels in the presence of constant ocean currents , 2008, 2008 47th IEEE Conference on Decision and Control.

[8]  John M. Lee Introduction to Topological Manifolds , 2000 .

[9]  Weijia Yao,et al.  Path following control in 3D using a vector field , 2019, Autom..

[10]  Maciej Michalek,et al.  VFO Path following Control with Guarantees of Positionally Constrained Transients for Unicycle-Like Robots with Constrained Control Input , 2018, J. Intell. Robotic Syst..

[11]  Khac Duc Do Global output-feedback path-following control of unicycle-type mobile robots: A level curve approach , 2015, Robotics Auton. Syst..

[12]  Francesco Mondada,et al.  The e-puck, a Robot Designed for Education in Engineering , 2009 .

[13]  Weijia Yao,et al.  Robotic Path Following in 3D Using a Guiding Vector Field , 2018, 2018 IEEE Conference on Decision and Control (CDC).

[14]  Zhiyong Sun,et al.  Circular formation control of fixed-wing UAVs with constant speeds , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[15]  Yu-Ping Tian,et al.  A curve extension design for coordinated path following control of unicycles along given convex loops , 2011, Int. J. Control.

[16]  David Q. Mayne,et al.  Feedback limitations in nonlinear systems: from Bode integrals to cheap control , 1999, IEEE Trans. Autom. Control..

[17]  Guilherme A. S. Pereira,et al.  Vector Fields for Robot Navigation Along Time-Varying Curves in $n$ -Dimensions , 2010, IEEE Transactions on Robotics.

[18]  Aleksandr Kapitonov,et al.  Geometric path following control of a rigid body based on the stabilization of sets , 2014 .

[19]  R. Langevin Differential Geometry of Curves and Surfaces , 2001 .

[20]  P. B. Sujit,et al.  Unmanned Aerial Vehicle Path Following: A Survey and Analysis of Algorithms for Fixed-Wing Unmanned Aerial Vehicless , 2014, IEEE Control Systems.

[21]  João Pedro Hespanha,et al.  Performance limitations in reference tracking and path following for nonlinear systems , 2008, Autom..

[22]  Renato Zaccaria,et al.  Path Following for Unicycle Robots With an Arbitrary Path Curvature , 2011, IEEE Transactions on Robotics.

[23]  Roger Skjetne,et al.  Line-of-sight path following of underactuated marine craft , 2003 .

[24]  Asgeir J. Sørensen,et al.  Integral Line-of-Sight Guidance and Control of Underactuated Marine Vehicles: Theory, Simulations, and Experiments , 2016, IEEE Transactions on Control Systems Technology.

[25]  Renato Zaccaria,et al.  3D path following with no bounds on the path curvature through surface intersection , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[26]  M. Michaek,et al.  Vector-Field-Orientation Feedback Control Method for a Differentially Driven Vehicle , 2010, IEEE Transactions on Control Systems Technology.

[27]  Eric W. Frew,et al.  Lyapunov Vector Fields for Autonomous Unmanned Aircraft Flight Control , 2008 .

[28]  Ming Cao,et al.  Guidance algorithm for smooth trajectory tracking of a fixed wing UAV flying in wind flows , 2016, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[29]  Weijia Yao,et al.  Vector Field Guided Path Following Control: Singularity Elimination and Global Convergence , 2020, 2020 59th IEEE Conference on Decision and Control (CDC).

[30]  Balazs Gati,et al.  Open source autopilot for academic research - The Paparazzi system , 2013, 2013 American Control Conference.

[31]  Ming Cao,et al.  Integrated Path Following and Collision Avoidance Using a Composite Vector Field , 2019, 2019 IEEE 58th Conference on Decision and Control (CDC).

[32]  Yingmin Jia,et al.  Combined Vector Field Approach for 2D and 3D Arbitrary Twice Differentiable Curved Path Following with Constrained UAVs , 2016, J. Intell. Robotic Syst..

[33]  Maciej Michalek,et al.  The VFO path-following kinematic controller for robotic vehicles moving in a 3D space , 2017, 2017 11th International Workshop on Robot Motion and Control (RoMoCo).

[34]  Luca Consolini,et al.  Path following for the PVTOL aircraft , 2010, Autom..

[35]  Kristin Y. Pettersen,et al.  A Comparison Between the ILOS Guidance and the Vector Field Guidance , 2015 .

[36]  H A Hazen,et al.  THE MECHANICS OF FLIGHT. , 1893, Science.

[37]  Antonio M. Pascoal,et al.  Adaptive, non-singular path-following control of dynamic wheeled robots , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[38]  G. Oriolo,et al.  Robotics: Modelling, Planning and Control , 2008 .

[39]  Danwei Wang,et al.  Ground Target Tracking Using UAV with Input Constraints , 2013, J. Intell. Robotic Syst..

[40]  Guilherme V. Raffo,et al.  Robust Fixed-Wing UAV Guidance with Circulating Artificial Vector Fields , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).