[发明专利]一种无人机飞行路径规划方法、装置、设备和存储介质

说明书

本申请公开了一种无人机飞行路径规划方法、装置、设备和存储介质，其中方法包括：S1、根据无人机飞行的起点和目标点生成第一规划路径，并控制无人机沿第一规划路径飞行；S2、在无人机和障碍物之间的距离小于第一数值的情况下，获取无人机的当前位置对应的第一表面网格点；S3、根据第一表面网格点和相邻表面网格点之间的向量，确定下一表面网格点；S4、控制无人机飞行至下一位置点，获取下一位置点对应的第二表面网格点；S5、将第二表面网格点作为新的第一表面网格点并返回S3，直至无人机和第一规划路经之间的距离小于第二数值，并控制无人机重新飞行至第一规划路径中。解决了现有的无人机路径规划方法不容易实时调整的技术问题。

技术领域

本申请涉及无人机领域，尤其涉及一种无人机飞行路径规划方法、装置、设备和存储介质。

背景技术

随着科技技术的发展，无人驾驶飞机(简称无人机)由于结构简单、机动性强等特点，在诸多领域得到了广泛应用。

无人机的飞行路径规划是无人机应用的基础环节，因此无人机的飞行路径规划一直是相关人员的研究热点。现有技术中的无人机路径规划方法，多基于人工智能等较为复杂的方法，对处理器等硬件要求较高，实际无人机飞行过程中，不容易根据现场工况变化做出实时调整。

发明内容

本申请提供了一种无人机飞行路径规划方法、装置、设备和存储介质，解决了现有的无人机路径规划方法，多基于人工智能等较为复杂的方法，对处理器等硬件要求较高，实际无人机飞行过程中，不容易根据现场工况变化做出实时调整的技术问题。

有鉴于此，本申请第一方面提供了一种无人机飞行路径规划方法，包括：

步骤S1、根据无人机飞行的起点和目标点，生成第一规划路径，并控制所述无人机沿所述第一规划路径飞行；

步骤S2、在飞行过程中，在所述无人机和障碍物之间的距离小于第一数值的情况下，获取所述无人机的当前位置对应的第一表面网格点，所述第一表面网格点位于所述障碍物的表面上；

步骤S3、根据所述第一表面网格点和相邻表面网格点之间的向量，确定所述第一表面网格点的下一表面网格点；

步骤S4、控制所述无人机飞行至下一位置点，获取所述下一位置点对应的第二表面网格点，所述下一位置点和所述下一表面网格点之间的距离为所述第一数值；

步骤S5、将所述第二表面网格点作为新的第一表面网格点并返回步骤S3，直至所述无人机和所述第一规划路经之间的距离小于第二数值，并控制所述无人机重新飞行至所述第一规划路径中。

可选地，步骤S3具体包括：

步骤S31、计算所述第一表面网格点和各相邻表面网格点之间的第一向量；

步骤S32、获取从所述起点指向所述目标点的单位向量；

步骤S33、根据所述单位向量和所述第一向量的方向关系，从所述相邻表面网格点中确定所述第一表面网格点的下一表面网格点。

可选地，步骤S33具体包括：

步骤S331、计算由所述第一向量和所述单位向量构成的夹角的角度值；

步骤S332、将所述角度值最小的相邻表面网格点作为所述第一表面网格点的下一表面网格点。

可选地，步骤S31具体包括：

步骤S311、获取所述第一表面网格点的相邻表面网格点；

步骤S312、获取所述第一表面网格点对应的第一坐标和各相邻表面网格点对应的第二坐标；

步骤S313、基于向量计算公式，根据所述第一坐标和所述第二坐标，计算所述第一表面网格点和各相邻表面网格点之间的第一向量，其中，所述向量计算公式为：