Fast Path Planning of Autonomous Vehicles in 3D Environments

Abstract

Three dimensional path planner is crucial for the safe navigation of autonomous vehicles (AV), such as unmanned aerial vehicles or unmanned underwater vehicles, which operate in three dimensions. In this paper, we develop a novel 3D path planner, which is fast in generating a near-optimal solution path. The planner generates the 3D path considering the size of an AV so that as the AV traverses the constructed path, it does not collide with an obstacle. This paper introduces a 3D path planner with novel concepts, such as a virtual agent and virtual sensors. In order to generate a 3D path to the goal as fast as possible, we let the virtual agent deploy virtual sensors iteratively, such that the connected sensor network can be formed. The constructed sensor network serves as a topological map for the AV, and we find a shortest path from the start to the goal utilizing the network. The virtual agent’s maneuver is biased towards the goal, in order to find a path to the goal as fast as possible. Moreover, the size of the agent is set considering the safety margin of the generated path. Through MATLAB simulations, we demonstrate the outperformance (low computational load and short path length) of our 3D path planner by comparing it with the 3D RRT-star algorithm.