Fast and Safe Path-Following Control using a State-Dependent Directional Metric

This paper considers the problem of fast and safe autonomous navigation in partially known environments. Our main contribution is a control policy design based on ellipsoidal trajectory bounds obtained from a quadratic state-dependent distance metric. The ellipsoidal bounds are used to embed directional preference in the control design, leading to system behavior that is adapted to local environment geometry, carefully considering medial obstacles while paying less attention to lateral ones. We use a virtual reference governor system to adaptively follow a desired navigation path, slowing down when system safety may be violated and speeding up otherwise. The resulting controller is able to navigate complex environments faster than common Euclidean-norm and Lyapunov-function-based designs, while retaining stability and collision avoidance guarantees.

[1]  Koushil Sreenath,et al.  Rapidly Exponentially Stabilizing Control Lyapunov Functions and Hybrid Zero Dynamics , 2014, IEEE Transactions on Automatic Control.

[2]  Kartik Mohta,et al.  Search-based motion planning for quadrotors using linear quadratic minimum time control , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[3]  P. Olver.  Nonlinear Systems , 2013 .

[4]  Andrew Packard,et al.  Stability Region Analysis Using Polynomial and Composite Polynomial Lyapunov Functions and Sum-of-Squares Programming , 2008, IEEE Transactions on Automatic Control.

[5]  Yi Lin,et al.  Online Safe Trajectory Generation for Quadrotors Using Fast Marching Method and Bernstein Basis Polynomial , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[6]  Daniel E. Koditschek,et al.  Integration of Local Geometry and Metric Information in Sampling-Based Motion Planning , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[7]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[8]  Sebastian Thrun,et al.  ARA*: Anytime A* with Provable Bounds on Sub-Optimality , 2003, NIPS.

[9]  Paulo Tabuada,et al.  Control Barrier Function Based Quadratic Programs for Safety Critical Systems , 2016, IEEE Transactions on Automatic Control.

[10]  E. Yaz.  Linear Matrix Inequalities In System And Control Theory , 1998, Proceedings of the IEEE.

[11]  Guofan Wu,et al.  Safety-critical and constrained geometric control synthesis using control Lyapunov and control Barrier functions for systems evolving on manifolds , 2015, 2015 American Control Conference (ACC).

[12]  Leslie Pack Kaelbling,et al.  LQR-RRT*: Optimal sampling-based motion planning with automatically derived extension heuristics , 2012, 2012 IEEE International Conference on Robotics and Automation.

[13]  Stefano Di Cairano,et al.  Reference and command governors: A tutorial on their theory and automotive applications , 2014, 2014 American Control Conference.

[14]  Guofan Wu,et al.  Safety-critical control of a planar quadrotor , 2016, 2016 American Control Conference (ACC).

[15]  Daniel E. Koditschek,et al.  Sequential Composition of Dynamically Dexterous Robot Behaviors , 1999, Int. J. Robotics Res..

[16]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[17]  Daniel E. Koditschek,et al.  Smooth extensions of feedback motion planners via reference governors , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[18]  Maciej Michalek,et al.  Algorithmization of Constrained Motion for Car-Like Robots Using the VFO Control Strategy with Parallelized Planning of Admissible Funnels , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[19]  Vijay Kumar,et al.  Planning Dynamically Feasible Trajectories for Quadrotors Using Safe Flight Corridors in 3-D Complex Environments , 2017, IEEE Robotics and Automation Letters.

[20]  S. Gruber,et al.  Robot hands and the mechanics of manipulation , 1987, Proceedings of the IEEE.

[21]  Russ Tedrake,et al.  Funnel libraries for real-time robust feedback motion planning , 2016, Int. J. Robotics Res..

[22]  Ian R. Manchester,et al.  LQR-trees: Feedback Motion Planning via Sums-of-Squares Verification , 2010, Int. J. Robotics Res..

[23]  Jur P. van den Berg,et al.  Kinodynamic RRT*: Asymptotically optimal motion planning for robots with linear dynamics , 2013, 2013 IEEE International Conference on Robotics and Automation.

[24]  Emanuele Garone,et al.  Explicit Reference Governor for Constrained Nonlinear Systems , 2016, IEEE Transactions on Automatic Control.

[25]  Maciej Michalek,et al.  VFO feedback control using positively-invariant funnels for mobile robots travelling in polygonal worlds with bounded curvature of motion , 2017, 2017 IEEE International Conference on Advanced Intelligent Mechatronics (AIM).