Sensor-based reactive navigation in unknown convex sphere worlds

We construct a sensor-based feedback law that provably solves the real-time collision-free robot navigation problem in a compact convex Euclidean subset cluttered with unknown but sufficiently separated and strongly convex obstacles. Our algorithm introduces a novel use of separating hyperplanes for identifying the robot’s local obstacle-free convex neighborhood, affording a reactive (online-computed) continuous and piecewise smooth closed-loop vector field whose smooth flow brings almost all configurations in the robot’s free space to a designated goal location, with the guarantee of no collisions along the way. Specialized attention to planar navigable environments yields a necessary and sufficient condition on convex obstacles for almost-global navigation towards any goal location in the environment. We further extend these provable properties of the planar setting to practically motivated limited range, isotropic and anisotropic sensing models, and the non-holonomically constrained kinematics of the standard differential-drive vehicle. We conclude with numerical and experimental evidence demonstrating the effectiveness of the proposed sensory feedback motion planner.

[1]  Philip D. Plowright,et al.  Convexity , 2019, Optimization for Chemical and Biochemical Engineering.

[2]  Alejandro Ribeiro,et al.  Stochastic Artificial Potentials for Online Safe Navigation , 2016, IEEE Transactions on Automatic Control.

[3]  S. Ana,et al.  Topology , 2018, International Journal of Mathematics Trends and Technology.

[4]  Daniel E. Koditschek,et al.  Autonomous legged hill ascent , 2018, J. Field Robotics.

[5]  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).

[6]  Mingyu Wang,et al.  Safe Distributed Lane Change Maneuvers for Multiple Autonomous Vehicles Using Buffered Input Cells , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[7]  Nicholas Roy,et al.  Sensor-Based Reactive Symbolic Planning in Partially Known Environments , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[8]  Alejandro Ribeiro,et al.  Navigation Functions for Convex Potentials in a Space With Convex Obstacles , 2016, IEEE Transactions on Automatic Control.

[9]  Daniela Rus,et al.  Distributed target tracking in cluttered environments with guaranteed collision avoidance , 2017, 2017 International Symposium on Multi-Robot and Multi-Agent Systems (MRS).

[10]  Vasileios Vasilopoulos,et al.  Sensor-based legged robot homing using range-only target localization , 2017, 2017 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[11]  Daniel E. Koditschek,et al.  Sensory steering for sampling-based motion planning , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

[13]  Saptarshi Bandyopadhyay,et al.  Fast, On-line Collision Avoidance for Dynamic Vehicles Using Buffered Voronoi Cells , 2017, IEEE Robotics and Automation Letters.

[14]  Daniel E. Koditschek,et al.  Exact robot navigation using power diagrams , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[15]  Daniel E. Koditschek,et al.  Voronoi-based coverage control of heterogeneous disk-shaped robots , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[16]  Daniel E. Koditschek,et al.  Coordinated Robot Navigation via Hierarchical Clustering , 2015, IEEE Transactions on Robotics.

[17]  Omur Arslan,et al.  Clustering-based robot navigation and control , 2016 .

[18]  Franziska Hoffmann,et al.  Spatial Tessellations Concepts And Applications Of Voronoi Diagrams , 2016 .

[19]  Andreas Krause,et al.  Robot navigation in dense human crowds: Statistical models and experimental studies of human–robot cooperation , 2015, Int. J. Robotics Res..

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

[21]  Soon-Jo Chung,et al.  Motion primitives and 3D path planning for fast flight through a forest , 2015, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  P. Olver Nonlinear Systems , 2013 .

[23]  J. Penot Elements of Differential Calculus , 2013 .

[24]  Kostas J. Kyriakopoulos,et al.  Navigation Functions for everywhere partially sufficiently curved worlds , 2012, 2012 IEEE International Conference on Robotics and Automation.

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

[26]  Kostas J. Kyriakopoulos,et al.  Adjustable navigation functions for unknown sphere worlds , 2011, IEEE Conference on Decision and Control and European Control Conference.

[27]  Aaron M. Johnson,et al.  Autonomous legged hill and stairwell ascent , 2011, 2011 IEEE International Symposium on Safety, Security, and Rescue Robotics.

[28]  Howie Choset,et al.  Integrating planning and control for single-bodied wheeled mobile robots , 2011, Auton. Robots.

[29]  Richard Szeliski,et al.  Computer Vision - Algorithms and Applications , 2011, Texts in Computer Science.

[30]  Sonia Martinez,et al.  Deployment algorithms for a power‐constrained mobile sensor network , 2010 .

[31]  Alfred A. Rizzi,et al.  Autonomous navigation for BigDog , 2010, 2010 IEEE International Conference on Robotics and Automation.

[32]  Christian Vollmer,et al.  Learning to navigate through crowded environments , 2010, 2010 IEEE International Conference on Robotics and Automation.

[33]  Jorge Cortes,et al.  Distributed Control of Robotic Networks: A Mathematical Approach to Motion Coordination Algorithms , 2009 .

[34]  Howie Choset,et al.  Flow-Through Policies for Hybrid Controller Synthesis Applied to Fully Actuated Systems , 2009, IEEE Transactions on Robotics.

[35]  Vijay Kumar,et al.  Sensing and coverage for a network of heterogeneous robots , 2008, 2008 47th IEEE Conference on Decision and Control.

[36]  Simon Parsons,et al.  Principles of Robot Motion: Theory, Algorithms and Implementations by Howie Choset, Kevin M. Lynch, Seth Hutchinson, George Kantor, Wolfram Burgard, Lydia E. Kavraki and Sebastian Thrun, 603 pp., $60.00, ISBN 0-262-033275 , 2007, The Knowledge Engineering Review.

[37]  Kostas J. Kyriakopoulos,et al.  Locally Computable Navigation Functions for Sphere Worlds , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

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

[39]  Stephen P. Boyd,et al.  Convex Optimization , 2004, Algorithms and Theory of Computation Handbook.

[40]  Kaare Brandt Petersen,et al.  The Matrix Cookbook , 2006 .

[41]  Mark H. Overmars,et al.  Using Workspace Information as a Guide to Non-uniform Sampling in Probabilistic Roadmap Planners , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[42]  M. Farber Topological Complexity of Motion Planning , 2001, Discret. Comput. Geom..

[43]  M. Hirsch,et al.  Differential Equations, Dynamical Systems, and an Introduction to Chaos , 2003 .

[44]  Irl C. Bivens,et al.  Calculus, Early Transcendentals , 2002 .

[45]  F. Bullo,et al.  Coverage control for mobile sensing networks , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[46]  Dinesh Manocha,et al.  A Voronoi-based hybrid motion planner , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[47]  Lydia E. Kavraki,et al.  A framework for using the workspace medial axis in PRM planners , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[48]  Howie Choset,et al.  Sensor-Based Exploration: The Hierarchical Generalized Voronoi Graph , 2000, Int. J. Robotics Res..

[49]  Atsuyuki Okabe,et al.  Spatial Tessellations: Concepts and Applications of Voronoi Diagrams, Second Edition , 2000, Wiley Series in Probability and Mathematical Statistics.

[50]  Alessandro Astolfi,et al.  Exponential Stabilization of a Wheeled Mobile Robot Via Discontinuous Control , 1999 .

[51]  Nancy M. Amato,et al.  MAPRM: a probabilistic roadmap planner with sampling on the medial axis of the free space , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[52]  Paolo Fiorini,et al.  Motion Planning in Dynamic Environments Using Velocity Obstacles , 1998, Int. J. Robotics Res..

[53]  Howie Choset,et al.  Coverage Path Planning: The Boustrophedon Cellular Decomposition , 1998 .

[54]  Frank L. Lewis,et al.  Control of a nonholomic mobile robot: Backstepping kinematics into dynamics , 1997, J. Field Robotics.

[55]  Wolfram Burgard,et al.  The dynamic window approach to collision avoidance , 1997, IEEE Robotics Autom. Mag..

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

[57]  Reid G. Simmons,et al.  The curvature-velocity method for local obstacle avoidance , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[58]  Jiming Liu Sensitivity Analysis in Nonlinear Programs and Variational Inequalities via Continuous Selections , 1995 .

[59]  S. Scholtes,et al.  Structural Analysis of Nonsmooth Mappings, Inverse Functions, and Metric Projections , 1994 .

[60]  Roderic A. Grupen,et al.  The applications of harmonic functions to robotics , 1993, J. Field Robotics.

[61]  Daniel E. Koditschek,et al.  Exact robot navigation using artificial potential functions , 1992, IEEE Trans. Robotics Autom..

[62]  Atsuyuki Okabe,et al.  Spatial Tessellations: Concepts and Applications of Voronoi Diagrams , 1992, Wiley Series in Probability and Mathematical Statistics.

[63]  Daniel E. Koditschek Some Applications of Natural Motion Control , 1991 .

[64]  Yoram Koren,et al.  The vector field histogram-fast obstacle avoidance for mobile robots , 1991, IEEE Trans. Robotics Autom..

[65]  D. Koditschek,et al.  Robot navigation functions on manifolds with boundary , 1990 .

[66]  R. W. Chaney Piecewise functions in nonsmooth analysis , 1990 .

[67]  A. Shapiro Sensitivity analysis of nonlinear programs and differentiability properties of metric projections , 1988 .

[68]  B. Fornberg Generation of finite difference formulas on arbitrarily spaced grids , 1988 .

[69]  Xinhua Zhuang,et al.  Image Analysis Using Mathematical Morphology , 1987, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[70]  Daniel E. Koditschek,et al.  Exact robot navigation by means of potential functions: Some topological considerations , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[71]  Franz Aurenhammer,et al.  Power Diagrams: Properties, Algorithms and Applications , 1987, SIAM J. Comput..

[72]  Daniel E. Koditschek,et al.  Adaptive Techniques for Mechanical Systems , 1987 .

[73]  R. Rockafellar,et al.  Lipschitzian properties of multifunctions , 1985 .

[74]  O. Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[75]  Chee-Keng Yap,et al.  A "Retraction" Method for Planning the Motion of a Disc , 1985, J. Algorithms.

[76]  R. Phelps,et al.  Differentiability of the metric projection in Hilbert space , 1982 .

[77]  R. W. Brockett,et al.  Asymptotic stability and feedback stabilization , 1982 .

[78]  L. Khachiyan,et al.  The polynomial solvability of convex quadratic programming , 1980 .

[79]  R. Holmes Smoothness of certain metric projections on Hilbert space , 1973 .

[80]  G. P. Szegö,et al.  Stability theory of dynamical systems , 1970 .