[发明专利]无人机的飞行路径规划方法及无人机

说明书

技术领域

本发明涉及自主导航技术领域，特别涉及一种无人机的飞行路径规划方法及无人机。

背景技术

无人机具有费效比低、零伤亡和部署灵活等优点，通过配备传感器感知飞行环境以设计路径，同时还具备环境信息收集、建模，特定目标任务的规划、分解和执行能力。小型无人机因其体积小、控制灵活、可以做多种特殊动作，在军事和民用领域得到了广泛应用。尤其在抢险救灾，基础设施如石油管道、矿井等狭窄区域的探测等方面，小型无人机有着广阔的应用和发展前景。

现有的路径规划算法，基于机载传感器感知飞行环境的纹理和深度信息，重建飞行环境的同时在规划层计算出无人机的飞行路线，适用于较为宽敞的应用场景。对环境建模的精确度和路径规划的精细度要求不是很高，无法适用于小型无人机在狭窄室内环境下的飞行路径规划。

发明内容

本发明的目的旨在至少解决上述的技术缺陷之一。

为此，本发明一方面提供一种无人机的飞行路径规划方法。

本发明的另一方面提出一种无人机。

有鉴于此，本发明一方面的实施例提出一种无人机的飞行路径规划方法，包括以下步骤：栅格地图生成步骤，获取无人机飞行环境的深度信息，并根据所述深度信息生成所述飞行环境的二维栅格地图，所述飞行环境包括障碍物；势函数构建步骤，根据所述二维栅格地图中每个栅格和所述障碍物的位置构建每个栅格与对应障碍物的势函数；加权图生成步骤，根据所述无人机的位置和所述势函数获得所述二维栅格地图中栅格的加权图；以及飞行路径确定步骤，根据所述加权图确定飞行路径。

根据本发明实施例的方法，通过二维栅格地图构建势函数，并通过由势函数得到的加权图确定飞行路径，提高了计算效率，同时具有良好的扩展性。

在本发明的一个实施例中，所述深度信息为距离。

在本发明的一个实施例中，所述加权图生成步骤具体包括：分别计算所述无人机移动到所述二维栅格地图中多个栅格的权值；根据所述无人机的位置、所述多个栅格的权值和所述势函数获得所述二维栅格地图中栅格的加权图。

在本发明的一个实施例中，所述飞行路径确定步骤具体为，根据所述加权图中每个栅格的加权值采用SPFA算法确定所述无人机的飞行路径。

在本发明的一个实施例中，还包括：路径点确定步骤，根据所述无人机的飞行速度和安全距离得到下一个飞行点。

在本发明的一个实施例中，在所述二维栅格地图中通过不同的数值表示该栅格是否为障碍物。

在本发明的一个实施例中，所述每个栅格与对应障碍物的势函数通过如下公式表示，所述公式为，其中，为所述势函数，为正常数，d_m为所述无人机与障碍物的最短距离，d₀为安全距离。

在本发明的一个实施例中，所述权值通过如下公式获得，所述公式为，其中，C₀₁为从当前位置p₀(x₀,y₀)移动到p₁(x₁,y₁)点的权值，K₁和K₂分别为加权常数，d₀₁为当前位置p₀到p₁的距离，为栅格(x₁,y₁)的势函数。

本发明另一方面的实施例提出了一种无人机，包括：栅格地图生成模块，用于获取无人机飞行环境的深度信息，并根据所述深度信息生成所述飞行环境的二维栅格地图，所述飞行环境包括障碍物；势函数构建模块，根据所述二维栅格地图中每个栅格和所述障碍物的位置构建每个栅格与对应障碍物的势函数；加权图生成模块，根据所述无人机的位置和所述势函数获得所述二维栅格地图中栅格的加权图；以及飞行路径确定模块，用于根据所述加权图中每个栅格的加权值采用SPFA算法确定所述无人机的飞行路径。

根据本发明实施例的无人机，通过二维栅格地图构建势函数，并通过由势函数得到的加权图确定飞行路径，提高了计算效率，同时具有良好的扩展性。

在本发明的一个实施例中，所述每个栅格与对应障碍物的势函数通过如下公式表示，所述公式为，其中，为所述势函数，为正常数，d_m为所述无人机与障碍物的最短距离，d₀为安全距离。

本发明附加的方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本发明的实践了解到。

附图说明