Connected invariant sets for high-speed motion planning in partially-known environments

Ensuring safety in partially-known environments is a critical problem in robotics since the environment is perceived through sensors and the environment cannot be completely known ahead of time. Prior work has considered the problem of finding positive control invariant sets (PCIS). However, this approach limits the planning horizon of the motion planner since the PCIS must lie completely in the limited known part of the environment. Here we consider the problem of guaranteeing safety by ensuring the existence of at least one PCIS in partially-known environments leading to an extension of the PCIS concept. It is shown, that this novel method is less conservative than the common PCIS approach and robust to unknown small obstacles which might appear in the close vicinity of the robot. An example implementation for loiter circles and power line obstacles is presented. Simulation scenarios are used for validating the proposed concept.

[1]  Eduardo F. Camacho,et al.  Robust tube-based MPC for tracking of constrained linear systems with additive disturbances , 2010 .

[2]  Brandon D. Luders.  Robust trajectory planning for unmanned aerial vehicles in uncertain environments , 2008 .

[3]  Dorit S. Hochbaum,et al.  Approximation Algorithms for NP-Hard Problems , 1996 .

[4]  D. Mayne,et al.  Robust receding horizon control of constrained nonlinear systems , 1993, IEEE Trans. Autom. Control..

[5]  Dorit S. Hochba,et al.  Approximation Algorithms for NP-Hard Problems , 1997, SIGA.

[6]  Manfred Morari,et al.  Model predictive control: Theory and practice - A survey , 1989, Autom..

[7]  Thierry Fraichard,et al.  Inevitable Collision States: A probabilistic perspective , 2010, 2010 IEEE International Conference on Robotics and Automation.

[8]  Noga Alon,et al.  Algorithmic construction of sets for k-restrictions , 2006, TALG.

[9]  Martin Buss,et al.  Safety assessment of robot trajectories for navigation in uncertain and dynamic environments , 2011, Autonomous Robots.

[10]  Thierry Fraichard,et al.  An Inevitable Collision State-Checker for a Car-Like Vehicle , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[11]  Emilio Frazzoli,et al.  High-speed flight in an ergodic forest , 2012, 2012 IEEE International Conference on Robotics and Automation.

[12]  Hajime Asama,et al.  Inevitable collision states. A step towards safer robots? , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[13]  Henning Fernau,et al.  Exact Elimination of Cycles in Graphs , 2007, Structure Theory and FPT Algorithmics for Graphs, Digraphs and Hypergraphs.

[14]  Arthur G. Richards,et al.  Robust stable model predictive control with constraint tightening , 2006, 2006 American Control Conference.

[15]  Hajime Asama,et al.  Inevitable collision states — a step towards safer robots? , 2004, Adv. Robotics.

[16]  J. Kuffner,et al.  Improved Motion Planning Speed and Safety using Regions of Inevitable Collision , 2008 .

[17]  Kenneth L. Clarkson,et al.  Improved Approximation Algorithms for Geometric Set Cover , 2007, Discret. Comput. Geom..

[18]  Manfred Morari,et al.  Model predictive control: Theory and practice , 1988 .

[19]  Friedrich Kiessling,et al.  Overhead Power Lines , 2003 .

[20]  J. Maciejowski,et al.  Invariant sets for constrained nonlinear discrete-time systems with application to feasibility in model predictive control , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[21]  Tom Schouwenaars,et al.  Safe Trajectory Planning of Autonomous Vehicles , 2006 .

[22]  Franco Blanchini,et al.  Set invariance in control , 1999, Autom..

[23]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[24]  Thierry Fraichard,et al.  Collision avoidance in dynamic environments: An ICS-based solution and its comparative evaluation , 2009, 2009 IEEE International Conference on Robotics and Automation.

[25]  Sebastian Scherer,et al.  A Principled Approach to Enable Safe and High Performance Maneuvers for Autonomous Rotorcraft , 2014 .

[26]  Martin Buss,et al.  Lane-based safety assessment of road scenes using Inevitable Collision States , 2012, 2012 IEEE Intelligent Vehicles Symposium.