[发明专利]一种面向农用四旋翼无人机航迹规划改进方法

说明书

本发明公开了一种面向农用四旋翼无人机航迹规划改进方法，该方法针对传统A*算法规划出的路径不平滑，转折点较多最终导致不适合无人机直接飞行的问题，提出扩大A*算法的搜索空间，由传统的8领域搜索转化为24领域搜索。通过扩展搜索领域，算法对于下一节点的扩展方向不再局限于π/4的整数倍，最终使得规划出来的路径适合无人机飞行。

技术领域

本发明属于无人机航迹规划技术领域，具体涉及一种面向农用四旋翼无人机航迹规划改进方法。

背景技术

无人机在喷洒农药过程中，首先需要无人机将农药配送到指定区域。对无人机配送农药过程中的航迹进行规划，一方面可以有效躲避农田中的障碍物，另一方面规划的航迹路程较短可以增加后期无人机喷洒农药的续航时间。

传统是使用A*算法完成航迹规划，A*算法在1969年被提出，其运算效率高于主流的Dijkstra算法而得到广泛的关注，研究人员将其应用于路径规划中，发现其效率和结果远高于其他算法，A*算法是一种静态路网中求解最短路径最有效的直接搜索算法，是一种常用的启发式搜索算法。但是A*算法所得到的路径通常不平滑，后期需要对路径进行平滑化。

发明内容

为解决上述问题，本发明公开了一种面向农用四旋翼无人机航迹规划改进方法，在栅格图中扩大节点的搜索领域至24领域，得到一条比传统A*算法更加平滑的路径，降低了转折点数，更加适合无人机飞行。

为达到上述目的，本发明的技术方案如下：

一种面向农用四旋翼无人机航迹规划改进方法，包括以下步骤：

S1，将各种环境、地图等因素抽象成计算机所能理解的计算机模型，常采用栅格法来建模。首先对地图预处理，然后对图像进行二值化处理，二值化的目的是根据地图生成二值化地图，其中黑色部分表示障碍物，白色部分表示无人机可航行区域。然后再采用栅格法生成环境建模，在选择栅格颗粒大小时，需要考虑实际的建模环境，栅格的尺寸越小，环境模型也越准确，但是运算效率就越低，反之栅格尺寸越大，环境模型就越粗糙，运算效率就越高。

S2，创建两个列表openlist，closelist，同时获取待规划路径的起始节点和目标节点。

S3，从起点s开始，把s作为一个等待检查的方格，放入到openlist中。

S4，寻找起点s周围可以到达的方格(最多24个)，将它们放入到openlist中，并设置他们的父方格为s。

S5，从openlist中删除起点s，并将s放入到closelist中。

S6，计算周围方格的F值。f(n)＝g(n)+h(n)，g(n)表示从起点到s到指定方格的移动消耗，设定横向移动一个格子消耗为10，斜向移动一个格子消耗为14，H表示从指定的方格移动到目标E点的预计消耗，H的计算方法为忽略障碍物，只进行纵横向计算。

S7，从openlist中选择F值最小的方格a，将其从openlist中删除，放入到closelist中。

S8，检查a所有临近且可达的方格，分为以下三种情况：

1)障碍物和关闭列表中的方格不考虑

2)如果这些方格还不在openlist中，将他们加入到openlist中，并且计算这些方格的F值，并设置父方格为a。

3)如果相邻的方格c已经在openlist中，计算新的路径从s到达方格c(经过a的路径)，判断G值是否更低一些，如果新的G值更低，修改父方格为a，从新计算F值。如果新的G值比较高，则F值不做改变。

S9，继续从openlist中找出F值较小的，并且从openlist中删除，添加到closelist，再继续找出周围可以到达的方块，如此循环。