Unmanned aerial vehicle independent pathfinding obstacle avoiding method and system

Abstract

The invention provides an unmanned aerial vehicle independent pathfinding obstacle avoiding method and system. The method comprises the following steps of collecting position information of an obstacle; performing three-dimensional environment modeling by a grid method; a model is divided into a plurality of grids; the grids comprising obstacles and grids not comprising the obstacles are subjectedto treatment of different colors; the grids are divided through a judging plane passing through an initial point and a target terminal point to obtain a two-dimensional grid model; on the basis of anA* algorithm, the global static path plan is made on the two-dimensional grid model; after the global static path planning, the local dynamic path planning is performed; through a Bezier curve, the planned path points are subjected to track tracking; the smoothening processing on the path track is completed. Through the global static path planning and the local dynamic path planning, an unmannedaerial vehicle can timely discover the obstacle position change due to dynamic change of environment; the calculation process is simple, convenient and fast; the problem that the obstacle collision easily occurs in a conventional flight route is solved.

Description

technical field [0001] The invention relates to the field of UAV path planning and trajectory tracking, in particular to a UAV autonomous path finding and obstacle avoidance method and system. Background technique [0002] UAVs can perform tasks with various requirements in complex environments. Due to the complexity and variability of the environment, UAVs will encounter various problems when performing tasks. The main problem is that the obstacles around the UAV increase due to the changeable environment, making it impossible for the UAV to bypass the obstacles and perform tasks correctly. Going directly around obstacles in a straight line may also cause an accident with a collision paddle. Due to the complexity and variability of the environment, static obstacle avoidance pathfinding can no longer meet the ever-changing complex environment. Therefore, a dynamic planning method that monitors environmental changes in real time and changes paths in real time must be adopted...

AI Technical Summary

Problems solved by technology

Since most of the existing related algorithms deal with static maps and environments, although they perform well in static environments, they are not good enough in the field of dynamic environments.

Images