Extending the Path-Planning Horizon

The mobility sensors on a typical mobile robot vehicle have limited range. Therefore a navigation system has no knowledge about the world beyond this sensing horizon. As a result, path planners that rely only on this knowledge to compute paths are unable to anticipate obstacles sufficiently early and have no choice but to resort to an inefficient local obstacle avoidance behavior. To alleviate this problem, we present an opportunistic navigation and view planning strategy that incorporates look-ahead sensing of possible obstacle configurations. This planning strategy is based on a “what-if” analysis of hypothetical future configurations of the environment. Candidate sensing positions are evaluated based on their ability to observe anticipated obstacles. These sensing positions identified by this forward-simulation framework are used by the planner as intermediate waypoints. The validity of the strategy is supported by results from simulations as well as field experiments with a real robotic platform. These results show that significant reduction in path length can be achieved by using this framework.

[1]  Nils J. Nilsson,et al.  A mobius automation: an application of artificial intelligence techniques , 1969, IJCAI 1969.

[2]  Nils J. Nilsson,et al.  A Mobile Automaton: An Application of Artificial Intelligence Techniques , 1969, IJCAI.

[3]  W. W. Bledsoe,et al.  Review of "Problem-Solving Methods in Artificial Intelligence by Nils J. Nilsson", McGraw-Hill Pub. , 1971, SGAR.

[4]  Nils J. Nilsson,et al.  Problem-solving methods in artificial intelligence , 1971, McGraw-Hill computer science series.

[5]  B. McCoy,et al.  The Two-Dimensional Ising Model , 1973 .

[6]  E. Masterson,et al.  Summary , 1981, Vision Research.

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

[8]  J. Besag.  On the Statistical Analysis of Dirty Pictures , 1986 .

[9]  Rodney A. Brooks,et al.  A Robust Layered Control Syste For A Mobile Robot , 2022 .

[10]  S. Y. Harmon.  The ground surveillance robot (GSR): An autonomous vehicle designed to transit unknown terrain , 1987, IEEE J. Robotics Autom..

[11]  Anthony Stentz,et al.  The CMU system for mobile robot navigation , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[12]  Olivier Faugeras,et al.  Motion and Structure from Motion in a piecewise Planar Environment , 1988, Int. J. Pattern Recognit. Artif. Intell..

[13]  John G. Harris,et al.  Autonomous cross-country navigation with the ALV , 1988, Proceedings. 1988 IEEE International Conference on Robotics and Automation.

[14]  M.J. Daily,et al.  An operational perception system for cross-country navigation , 1988, Proceedings CVPR '88: The Computer Society Conference on Computer Vision and Pattern Recognition.

[15]  Micha Sharir,et al.  Algorithmic motion planning in robotics , 1991, Computer.

[16]  D. Greig,et al.  Exact Maximum A Posteriori Estimation for Binary Images , 1989 .

[17]  Anthony Stentz,et al.  The Navlab system for mobile robot navigation , 1990 .

[18]  Yoram Koren,et al.  Potential field methods and their inherent limitations for mobile robot navigation , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[19]  H. C. Longuet-Higgins,et al.  An algorithm for associating the features of two images , 1991, Proceedings of the Royal Society of London. Series B: Biological Sciences.

[20]  William S. Lovejoy,et al.  Computationally Feasible Bounds for Partially Observed Markov Decision Processes , 1991, Oper. Res..

[21]  Frank P. Ferrie,et al.  From Uncertainty to Visual Exploration , 1991, IEEE Trans. Pattern Anal. Mach. Intell..

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

[23]  Chee Sun Won,et al.  Unsupervised segmentation of noisy and textured images using Markov random fields , 1992, CVGIP Graph. Model. Image Process..

[24]  Michael Brady,et al.  Feature-based correspondence: an eigenvector approach , 1992, Image Vis. Comput..

[25]  Rajeev Sharma,et al.  Probabilistic analysis of some navigation strategies in a dynamic environment , 1993, IEEE Trans. Syst. Man Cybern..

[26]  S. Sitharama Iyengar,et al.  Robot navigation in unknown terrains: Introductory survey of non-heuristic algorithms , 1993 .

[27]  Ruzena Bajcsy,et al.  Occlusions as a Guide for Planning the Next View , 1993, IEEE Trans. Pattern Anal. Mach. Intell..

[28]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[29]  Vladimir J. Lumelsky,et al.  Provable strategies for vision-guided exploration in three dimensions , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[30]  Lambert E. Wixson,et al.  Viewpoint selection for visual search , 1994, 1994 Proceedings of IEEE Conference on Computer Vision and Pattern Recognition.

[31]  Martial Hebert,et al.  A Reactive System For Off-Road Navigation , 1994 .

[32]  Leslie Pack Kaelbling,et al.  Acting Optimally in Partially Observable Stochastic Domains , 1994, AAAI.

[33]  Rachid Alami,et al.  Planning robust motion strategies for a mobile robot , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[34]  Thierry Siméon,et al.  3-D autonomous navigation in a natural environment , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[35]  John Hershberger,et al.  Computing Minimum Length Paths of a Given Homotopy Class , 1994, Comput. Geom..

[36]  Thierry Siméon,et al.  Autonomous navigation in outdoor environment: adaptive approach and experiment , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[37]  Jon M. Kleinberg,et al.  On-line search in a simple polygon , 1994, SODA '94.

[38]  Zen Chen,et al.  Terrain Exploration of a Sensor-Based Robot Moving Among Unknown Obstacles of Polygonal Shape , 1994, Robotica.

[39]  Mongi A. Abidi,et al.  Best-next-view algorithm for three-dimensional scene reconstruction using range images , 1995, Other Conferences.

[40]  Peter Norvig,et al.  Artificial Intelligence: A Modern Approach , 1995 .

[41]  Steven K. Feiner,et al.  Computer graphics (2nd ed. in C): principles and practice , 1995 .

[42]  H. Durrant-Whyte,et al.  Mobile vehicle navigation in unknown environments: a multiple hypothesis approach , 1995 .

[43]  Anthony Stentz,et al.  The Focussed D* Algorithm for Real-Time Replanning , 1995, IJCAI.

[44]  Fawzi Nashashibi,et al.  On autonomous navigation in a natural environment , 1995, Robotics Auton. Syst..

[45]  Dinesh K. Pai,et al.  Multiresolution rough terrain motion planning , 1995, Proceedings 1995 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human Robot Interaction and Cooperative Robots.

[46]  J.-C. Latombe,et al.  Continuous purposive sensing and motion for 2D map building , 1995, 1995 IEEE International Conference on Systems, Man and Cybernetics. Intelligent Systems for the 21st Century.

[47]  Simon Lacroix,et al.  Motion and Perception Strategies for Outdoor Mobile Robot Navigation in Unknown Environments , 1995, ISER.

[48]  J. Burdick,et al.  Sensor based planning. I. The generalized Voronoi graph , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[49]  Howie Choset,et al.  Sensor Based Planing, Part II: Incremental COnstruction of the Generalized Voronoi Graph , 1995, ICRA.

[50]  Andrew W. Moore,et al.  Reinforcement Learning: A Survey , 1996, J. Artif. Intell. Res..

[51]  A New Range-Sensor Based Globally Algorithm for Mobile , 1996 .

[52]  Steven M. LaValle,et al.  A game-theoretic framework for robot motion planning , 1996 .

[53]  Thierry Siméon,et al.  Motion planning on rough terrain for an articulated vehicle in presence of uncertainties , 1996, Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems. IROS '96.

[54]  Friedrich M. Wahl,et al.  Efficient, iterative, sensor based 3-D map building using rating functions in configuration space , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[55]  Howie Choset,et al.  Sensor based motion planning: the hierarchical generalized Voronoi graph , 1996 .

[56]  Richard Pito,et al.  A sensor-based solution to the "next best view" problem , 1996, Proceedings of 13th International Conference on Pattern Recognition.

[57]  Robert Ivlev,et al.  The Rocky 7 Mars rover prototype , 1996, Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems. IROS '96.

[58]  Dorin Comaniciu,et al.  Robust analysis of feature spaces: color image segmentation , 1997, Proceedings of IEEE Computer Society Conference on Computer Vision and Pattern Recognition.

[59]  Maurizio Pilu,et al.  A direct method for stereo correspondence based on singular value decomposition , 1997, Proceedings of IEEE Computer Society Conference on Computer Vision and Pattern Recognition.

[60]  M. Kam,et al.  Applying the Hungarian method to stereo matching , 1997, Proceedings of the 36th IEEE Conference on Decision and Control.

[61]  Julio Rosenblatt,et al.  DAMN: a distributed architecture for mobile navigation , 1997, J. Exp. Theor. Artif. Intell..

[62]  Martial Hebert,et al.  Intelligent Unmanned Ground Vehicles: Autonomous Navigation Research at Carnegie Mellon , 1997 .

[63]  Martial Hebert,et al.  Intelligent Unmanned Ground Vehicles , 1997 .

[64]  Ronen I. Brafman,et al.  A Heuristic Variable Grid Solution Method for POMDPs , 1997, AAAI/IAAI.

[65]  Rajeev Sharma,et al.  On Motion Planning in Changing, Partially Predictable Environments , 1997, Int. J. Robotics Res..

[66]  Simon Lacroix,et al.  Reactive navigation in outdoor environments using potential fields , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[67]  Alonzo Kelly,et al.  Rough Terrain Autonomous Mobility—Part 2: An Active Vision, Predictive Control Approach , 1998, Auton. Robots.

[68]  Andrew Zisserman,et al.  Wide baseline stereo matching , 1998, Sixth International Conference on Computer Vision (IEEE Cat. No.98CH36271).

[69]  C. M. Shoemaker,et al.  The Demo III UGV program: a testbed for autonomous navigation research , 1998, Proceedings of the 1998 IEEE International Symposium on Intelligent Control (ISIC) held jointly with IEEE International Symposium on Computational Intelligence in Robotics and Automation (CIRA) Intell.

[70]  K. Murphy,et al.  Path planning for autonomous vehicles driving over rough terrain , 1998, Proceedings of the 1998 IEEE International Symposium on Intelligent Control (ISIC) held jointly with IEEE International Symposium on Computational Intelligence in Robotics and Automation (CIRA) Intell.

[71]  Robert Mandelbaum,et al.  Vision for autonomous mobility: image processing on the VFE-200 , 1998, Proceedings of the 1998 IEEE International Symposium on Intelligent Control (ISIC) held jointly with IEEE International Symposium on Computational Intelligence in Robotics and Automation (CIRA) Intell.

[72]  Jean-Claude Latombe,et al.  Planning Robot Motions for Range-Image Acquisition and Automatic 3D Model Construction , 1998 .

[73]  Joel W. Burdick,et al.  Theory and experiments in autonomous sensor-based motion planning with applications for flight planetary microrovers , 1999 .

[74]  Wolfram Burgard,et al.  Coastal navigation-mobile robot navigation with uncertainty in dynamic environments , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[75]  Mark Huber,et al.  Efficient exact sampling from the Ising model using Swendsen-Wang , 1999, SODA '99.

[76]  Julio K. Rosenblatt,et al.  Optimal Selection of Uncertain Actions by Maximizing Expected Utility , 1999, Proceedings 1999 IEEE International Symposium on Computational Intelligence in Robotics and Automation. CIRA'99 (Cat. No.99EX375).

[77]  Andrew Zisserman,et al.  Automatic reconstruction of piecewise planar models from multiple views , 1999, Proceedings. 1999 IEEE Computer Society Conference on Computer Vision and Pattern Recognition (Cat. No PR00149).

[78]  Joel W. Burdick,et al.  An autonomous sensor-based path-planner for planetary microrovers , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[79]  Thierry Siméon,et al.  Robust motion planning for rough terrain navigation , 1999, Proceedings 1999 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human and Environment Friendly Robots with High Intelligence and Emotional Quotients (Cat. No.99CH36289).

[80]  Simon Lacroix,et al.  Autonomous Rover Navigation on Unknown Terrains Functions and Integration , 2000, ISER.

[81]  Héctor H. González-Baños,et al.  Robot Navigation for Automatic Model Construction Using Safe Regions , 2000, ISER.

[82]  Anthony Stentz,et al.  A Free Market Architecture for Distributed Control of a Multirobot System , 2000 .

[83]  M. Rosenblum,et al.  A high fidelity multi-sensor scene understanding system for autonomous navigation , 2000, Proceedings of the IEEE Intelligent Vehicles Symposium 2000 (Cat. No.00TH8511).

[84]  Oliver Brock,et al.  Real-time re-planning in high-dimensional configuration spaces using sets of homotopic paths , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[85]  Luc Van Gool,et al.  Wide Baseline Stereo Matching based on Local, Affinely Invariant Regions , 2000, BMVC.

[86]  Roberto Manduchi,et al.  Terrain perception for DEMO III , 2000, Proceedings of the IEEE Intelligent Vehicles Symposium 2000 (Cat. No.00TH8511).

[87]  Hugh F. Durrant-Whyte,et al.  Data association for mobile robot navigation: a graph theoretic approach , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[88]  J. Guivant.  Navigation Algorithms for Autonomous Machines in Off-Road Applications , 2000 .

[89]  Vijay Kumar,et al.  Closed loop motion plans for mobile robots , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[90]  Martial Hebert,et al.  Distributed robotic mapping of extreme environments , 2001, SPIE Optics East.

[91]  Eric A. Hansen,et al.  An Improved Grid-Based Approximation Algorithm for POMDPs , 2001, IJCAI.

[92]  A. Bartoli,et al.  Projective structure and motion from two views of a piecewise planar scene , 2001, Proceedings Eighth IEEE International Conference on Computer Vision. ICCV 2001.

[93]  Andrew Zisserman,et al.  Viewpoint invariant texture matching and wide baseline stereo , 2001, Proceedings Eighth IEEE International Conference on Computer Vision. ICCV 2001.

[94]  Stan Z. Li,et al.  Markov Random Field Modeling in Image Analysis , 2001, Computer Science Workbench.

[95]  C. Fox,et al.  Exact MAP states and expectations from perfect sampling: Greig, porteous and seheult revisited , 2001 .

[96]  Tommy Chang,et al.  Feature detection and tracking for mobile robots using a combination of ladar and color images , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[97]  Simon Lacroix,et al.  Autonomous Rover Navigation on Unknown Terrains: Functions and Integration , 2002, Int. J. Robotics Res..

[98]  Tommy Chang,et al.  Fusing Ladar and Color Image Information for Mobile Robot Feature Detection and Tracking , 2002 .

[99]  Ray Jarvis,et al.  Path planning for a mobile robot in a rough terrain environment , 2002, Proceedings of the Third International Workshop on Robot Motion and Control, 2002. RoMoCo '02..

[100]  Héctor H. González-Baños,et al.  Navigation Strategies for Exploring Indoor Environments , 2002, Int. J. Robotics Res..

[101]  Martial Hebert,et al.  Toward practical cooperative stereo for robotic colonies , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[102]  Christopher Rasmussen,et al.  Combining laser range, color, and texture cues for autonomous road following , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[103]  Sven Koenig,et al.  Improved fast replanning for robot navigation in unknown terrain , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[104]  Simon Lacroix,et al.  PG2P: a perception-guided path planning approach for long range autonomous navigation in unknown natural environments , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[105]  Mark Huber,et al.  A bounding chain for Swendsen‐Wang , 2003, Random Struct. Algorithms.

[106]  David Nistér,et al.  An efficient solution to the five-point relative pose problem , 2003, 2003 IEEE Computer Society Conference on Computer Vision and Pattern Recognition, 2003. Proceedings..

[107]  M. Maurette,et al.  Mars Rover Autonomous Navigation , 2003, Auton. Robots.

[108]  Howie Choset,et al.  Autonomous exploration via regions of interest , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[109]  Martial Hebert,et al.  Experimental Results in Using Aerial LADAR Data for Mobile Robot Navigation , 2003, FSR.

[110]  Sergei N. Bespamyatnikh.  Computing homotopic shortest paths in the plane , 2003, SODA '03.

[111]  Thomas P. Minka.  The ‘summation hack’ as an outlier model , 2003 .

[112]  Cang Ye,et al.  A method for mobile robot navigation on rough terrain , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[113]  Sanjiv Kumar,et al.  Models for learning spatial interactions in natural images , 2004 .

[114]  Joelle Pineau,et al.  Tractable planning under uncertainty: exploiting structure , 2004 .

[115]  Anthony Stentz,et al.  Planning with imperfect information , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[116]  Jack Snoeyink,et al.  Testing Homotopy for Paths in the Plane , 2004, Discret. Comput. Geom..

[117]  Nicolas Vandapel,et al.  Toward laser pulse waveform analysis for scene interpretation , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[118]  Sebastian Thrun,et al.  PAO for planning with hidden state , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[119]  Mark Rosenblum.  Immune systems are not just for making you feel better: they are for controlling autonomous robots , 2005, SPIE Defense + Commercial Sensing.

[120]  Anthony Stentz,et al.  Field D*: An Interpolation-Based Path Planner and Replanner , 2005, ISRR.

[121]  Wenyi Zhao,et al.  Alignment of Continuous Video onto 3D Point Clouds , 2005, IEEE Trans. Pattern Anal. Mach. Intell..

[122]  A. Stentz,et al.  The Field D * Algorithm for Improved Path Planning and Replanning in Uniform and Non-Uniform Cost Environments , 2005 .

[123]  Mark Rosenblum,et al.  The road more traveled: a foundation for autonomous roadway operations , 2005, SPIE Defense + Commercial Sensing.

[124]  Kiriakos N. Kutulakos,et al.  Recovering shape by purposive viewpoint adjustment , 1992, International Journal of Computer Vision.

[125]  Hobart R. Everett,et al.  Transitioning unmanned ground vehicle research technologies , 2005, SPIE Defense + Commercial Sensing.

[126]  Vladimir J. Lumelsky,et al.  Path-planning strategies for a point mobile automaton moving amidst unknown obstacles of arbitrary shape , 1987, Algorithmica.

[127]  Martial Hebert,et al.  Discriminative Random Fields , 2006, International Journal of Computer Vision.

[128]  Elon Rimon,et al.  Construction of C-space roadmaps from local sensory data. What should the sensors look for? , 1994, Algorithmica.

[129]  J. Andrew Bagnell,et al.  Improving Robot Navigation Through Self-Supervised Online Learning , 2006, Robotics: Science and Systems.

[130]  Alexander Zelinsky,et al.  Planning Paths of Complete Coverage of an Unstructured Environment by a Mobile Robot , 2007 .

[131]  M. Pauline Baker,et al.  Computer Graphics 2nd Ed , 2008 .

[132]  Stan Z. Li.  Markov Random Field Modeling in Image Analysis , 2009, Advances in Pattern Recognition.