D*+s: A Generic Platform-Agnostic and Risk-Aware Path Planing Framework with an Expandable Grid

This article establishes a novel generic and platform-agnostic risk-aware path planning framework that is based on the classical D∗ lite planner with a path design focus on safety and efficiency. The planner generates a grid map where the occupied/free/unknown spaces are represented with different traversal costs. As it will presented, in this case, a traversal cost is added to the unknown voxels that are close to an occupied one. The algorithmic implementation is also enhanced with a dynamic grid map that has the novel ability to update and expand during the robotic operation and thus increase the overall safety of the mission and it is suitable for exploration and search and rescue missions. On the generated grid map, the D∗ lite is able to plan a safer path that has a minimum traversal cost. The proposed path planning framework is suitable for generating 2D and 3D paths, for ground and aerial robots respectively and thus in the 3D case, the grid is created with one voxel height to plan for a 2D path, which is the main factor that differentiates between 2D and 3D path planning. The efficacy of the proposed novel path planning scheme is extensively evaluated in multiple simulation and real-world field experiments on both a quadcopter platform and the Boston Dynamics Spot legged robot.

[1]  Ariel Felner,et al.  Theta*: Any-Angle Path Planning on Grids , 2007, AAAI.

[2]  Amanda Bouman,et al.  Autonomous Spot: Long-Range Autonomous Exploration of Extreme Environments with Legged Locomotion , 2020, 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[3]  Clément Gosselin,et al.  Probabilistic octree modeling of a 3D dynamic environment , 1997, Proceedings of International Conference on Robotics and Automation.

[4]  Roland Siegwart,et al.  Voxblox: Incremental 3D Euclidean Signed Distance Fields for on-board MAV planning , 2016, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[5]  Jonathan P. How,et al.  FASTER: Fast and Safe Trajectory Planner for Navigation in Unknown Environments , 2020, IEEE Transactions on Robotics.

[6]  Neil C. Rowe,et al.  Finding Optimal-Path Maps for Path Planning across Weighted Regions , 2000, Int. J. Robotics Res..

[7]  Jan Faigl,et al.  On Unsupervised Learning of Traversal Cost and Terrain Types Identification Using Self-organizing Maps , 2019, ICANN.

[8]  Wolfgang Hess,et al.  Real-time loop closure in 2D LIDAR SLAM , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

[10]  Anthony Stentz,et al.  3D Field D: Improved Path Planning and Replanning in Three Dimensions , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Caleb Parker,et al.  Using the Unmanned Aerial Vehicle Delivery Decision Tool to Consider Transporting Medical Supplies via Drone , 2019, Global Health: Science and Practice.

[12]  Maxim Likhachev,et al.  D*lite , 2002, AAAI/IAAI.

[13]  Samia Nefti-Meziani,et al.  A comparative review on mobile robot path planning: Classical or meta-heuristic methods? , 2020, Annu. Rev. Control..

[14]  Sisi Zlatanova,et al.  Universal path planning for an indoor drone , 2018, Automation in Construction.

[15]  Hans P. Moravec,et al.  High resolution maps from wide angle sonar , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[16]  Jizhong Xiao,et al.  Path Planning in Complex 3D Environments Using a Probabilistic Roadmap Method , 2013, Int. J. Autom. Comput..

[17]  Roland Geraerts,et al.  Real‐time path planning in heterogeneous environments , 2013, Comput. Animat. Virtual Worlds.

[18]  Sina Sharif Mansouri,et al.  COMPRA: A COMPact Reactive Autonomy framework for subterranean MAV based search-and-rescue operations , 2021, ArXiv.

[19]  Roland Siegwart,et al.  Continuous-time trajectory optimization for online UAV replanning , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[20]  Jonathan P. How,et al.  FASTER: Fast and Safe Trajectory Planner for Flights in Unknown Environments , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[21]  Richard S. Middleton,et al.  CostMAP: An open-source software package for developing cost surfaces , 2019, 1906.08872.

[22]  Thomas Lew,et al.  NeBula: Quest for Robotic Autonomy in Challenging Environments; TEAM CoSTAR at the DARPA Subterranean Challenge , 2021, ArXiv.

[23]  Joel Burdick,et al.  STEP: Stochastic Traversability Evaluation and Planning for Safe Off-road Navigation , 2021, ArXiv.

[24]  Roland Siegwart,et al.  Safe Local Exploration for Replanning in Cluttered Unknown Environments for Microaerial Vehicles , 2017, IEEE Robotics and Automation Letters.

[25]  Anthony Stentz,et al.  Using interpolation to improve path planning: The Field D* algorithm , 2006, J. Field Robotics.

[26]  Joel Burdick,et al.  A Unified NMPC Scheme for MAVs Navigation With 3D Collision Avoidance Under Position Uncertainty , 2020, IEEE Robotics and Automation Letters.

[27]  George Nikolakopoulos,et al.  Deploying MAVs for autonomous navigation in dark underground mine environments , 2020, Robotics Auton. Syst..

[28]  Thierry Siméon,et al.  Sampling-Based Path Planning on Configuration-Space Costmaps , 2010, IEEE Transactions on Robotics.

[29]  George Nikolakopoulos,et al.  A Subterranean Virtual Cave World for Gazebo based on the DARPA SubT Challenge , 2020, ArXiv.