3D JPS Path Optimization Algorithm and Dynamic-Obstacle Avoidance Design Based on Near-Ground Search Drone
Yuan Luo, Jiakai Lu, Yi Zhang, Qiong Qin, Yanyu Liu
Abstract
As various fields and industries have progressed, the use of drones has grown tremendously. The problem of path planning for drones flying at low altitude in urban as well as mountainous areas will be crucial for drones performing search-and-rescue missions. In this paper, we propose a convergent approach to ensure autonomous collision-free path planning for drones in the presence of both static obstacles and dynamic threats. Firstly, this paper extends the jump point search algorithm (JPS) in three dimensions for the drone to generate collision-free paths based on static environments. Next, a parent node transfer law is proposed and used to implement the JPS algorithm for any-angle path planning, which further shortens the planning path of the drones. Furthermore, the optimized paths are smoothed by seventh-order polynomial interpolation based on minimum snap to ensure the continuity at the path nodes. Finally, this paper improves the artificial potential field (APF) method by a virtual gravitational field and 3D Bresenham’s line algorithm to achieve the autonomous obstacle avoidance of drones in a dynamic-threat conflict environment. In this paper, the performance of this convergent approach is verified by simulation experiments. The simulation results show that the proposed approach can effectively solve the path planning and autonomous-obstacle-avoidance problems of drones in low-altitude flight missions.