PathBench: A Benchmarking Platform for Classical and Learned Path Planning Algorithms

Path planning is a key component in mobile robotics. A wide range of path planning algorithms exist, but few attempts have been made to benchmark the algorithms holistically or unify their interface. Moreover, with the recent advances in deep neural networks, there is an urgent need to facilitate the development and benchmarking of such learning-based planning algorithms. This paper presents PathBench, a platform for developing, visualizing, training, testing, and benchmarking of existing and future, classical and learned 2D and 3D path planning algorithms, while offering support for Robot Operating System (ROS). Many existing path planning algorithms are supported; e.g. A*, wavefront, rapidly-exploring random tree, value iteration networks, gated path planning networks; and integrating new algorithms is easy and clearly specified. We demonstrate the benchmarking capability of PathBench by comparing implemented classical and learned algorithms for metrics, such as path length, success rate, computational time and path deviation. These evaluations are done on built-in PathBench maps and external path planning environments from video games and real world databases. PathBench is open source 1.

[1]  Andrej Babinec,et al.  Modelling of Mechanical and Mechatronic Systems MMaMS 2014 Path planning with modified A star algorithm for a mobile robot , 2014 .

[2]  Michael C. Yip,et al.  Neural Manipulation Planning on Constraint Manifolds , 2020, IEEE Robotics and Automation Letters.

[3]  Lydia E. Kavraki,et al.  The Open Motion Planning Library , 2012, IEEE Robotics & Automation Magazine.

[4]  Julius Ziegler,et al.  Making Bertha Drive—An Autonomous Journey on a Historic Route , 2014, IEEE Intelligent Transportation Systems Magazine.

[5]  Kostas E. Bekris,et al.  OOPS for Motion Planning: An Online, Open-source, Programming System , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[6]  M. Meng,et al.  HouseExpo: A Large-scale 2D Indoor Layout Dataset for Learning-based Algorithms on Mobile Robots , 2019, 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[7]  Narendra Ahuja,et al.  A potential field approach to path planning , 1992, IEEE Trans. Robotics Autom..

[8]  Luca Antiga,et al.  Automatic differentiation in PyTorch , 2017 .

[9]  David González,et al.  A Review of Motion Planning Techniques for Automated Vehicles , 2016, IEEE Transactions on Intelligent Transportation Systems.

[10]  Pieter Abbeel,et al.  Value Iteration Networks , 2016, NIPS.

[11]  Yasutaka Fujimoto,et al.  A LSTM Neural Network applied to Mobile Robots Path Planning , 2018, 2018 IEEE 16th International Conference on Industrial Informatics (INDIN).

[12]  Steven M. LaValle,et al.  A pursuit-evasion BUG algorithm , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[13]  Michael C. Yip,et al.  Deeply Informed Neural Sampling for Robot Motion Planning , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[14]  Sebastian Thrun,et al.  Path Planning for Autonomous Vehicles in Unknown Semi-structured Environments , 2010, Int. J. Robotics Res..

[15]  John D. Hunter,et al.  Matplotlib: A 2D Graphics Environment , 2007, Computing in Science & Engineering.

[16]  Thomas A. Funkhouser,et al.  Semantic Scene Completion from a Single Depth Image , 2016, 2017 IEEE Conference on Computer Vision and Pattern Recognition (CVPR).

[17]  James J. Kuffner,et al.  OpenRAVE: A Planning Architecture for Autonomous Robotics , 2008 .

[18]  S. LaValle Rapidly-exploring random trees : a new tool for path planning , 1998 .

[19]  Wolfram Burgard,et al.  Improved Techniques for Grid Mapping With Rao-Blackwellized Particle Filters , 2007, IEEE Transactions on Robotics.

[20]  Lydia E. Kavraki,et al.  Benchmarking Motion Planning Algorithms: An Extensible Infrastructure for Analysis and Visualization , 2014, IEEE Robotics & Automation Magazine.

[21]  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.

[22]  Nathan R. Sturtevant,et al.  Benchmarks for Grid-Based Pathfinding , 2012, IEEE Transactions on Computational Intelligence and AI in Games.

[23]  Takeshi Nishida,et al.  Robot Path Planning by LSTM Network Under Changing Environment , 2018, Advances in Intelligent Systems and Computing.

[24]  Maximilian Karl,et al.  Dynamic movement primitives in latent space of time-dependent variational autoencoders , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[25]  Allan Jabri,et al.  Universal Planning Networks , 2018, ICML.

[26]  Michael C. Yip,et al.  Motion Planning Networks: Bridging the Gap Between Learning-Based and Classical Motion Planners , 2019, IEEE Transactions on Robotics.

[27]  Pieter Abbeel,et al.  Autonomous Helicopter Aerobatics through Apprenticeship Learning , 2010, Int. J. Robotics Res..

[28]  Sajad Saeedi,et al.  Waypoint Planning Networks , 2021, 2021 18th Conference on Robots and Vision (CRV).

[29]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

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

[31]  Nathan R. Sturtevant,et al.  Benchmarks for Pathfinding in 3D Voxel Space , 2021, SOCS.

[32]  Keyu Wu,et al.  TDPP-Net: Achieving three-dimensional path planning via a deep neural network architecture , 2019, Neurocomputing.

[33]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[34]  Lydia E. Kavraki,et al.  Using Local Experiences for Global Motion Planning , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[35]  Michael C. Yip,et al.  Neural Path Planning: Fixed Time, Near-Optimal Path Generation via Oracle Imitation , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[36]  Eric P. Xing,et al.  Gated Path Planning Networks , 2018, ICML.

[37]  Liam Paull,et al.  Sensor driven online coverage planning for autonomous underwater vehicles , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[38]  Matthias Althoff,et al.  CommonRoad: Composable benchmarks for motion planning on roads , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[39]  Michael C. Yip,et al.  Motion Planning Networks , 2018, 2019 International Conference on Robotics and Automation (ICRA).

[40]  Mark R. Mine,et al.  The Panda3D Graphics Engine , 2004, Computer.

[41]  Ala I. Al-Fuqaha,et al.  Path Planning in Support of Smart Mobility Applications Using Generative Adversarial Networks , 2018, 2018 IEEE International Conference on Internet of Things (iThings) and IEEE Green Computing and Communications (GreenCom) and IEEE Cyber, Physical and Social Computing (CPSCom) and IEEE Smart Data (SmartData).

[42]  Dooseop Choi,et al.  PathGAN: Local Path Planning with Generative Adversarial Networks , 2020, ArXiv.

[43]  Morgan Quigley,et al.  ROS: an open-source Robot Operating System , 2009, ICRA 2009.

[44]  Rahul Sukthankar,et al.  Cognitive Mapping and Planning for Visual Navigation , 2017, International Journal of Computer Vision.

[45]  Ehud Rivlin,et al.  Sensory-based motion planning with global proofs , 1997, IEEE Trans. Robotics Autom..

[46]  Mike Goslin,et al.  The Panda 3 D Graphics Engine , 2022 .

[47]  Sergey Levine,et al.  Guided Policy Search , 2013, ICML.