一种基于改进蚁群算法的无人机航迹规划方法

1.本发明提出一种基于改进蚁群算法的无人机航迹规划算法研究，在保证无人机飞行中安全避障的前提下，提出借鉴“卒”的走法规则，引入状态参数方程阈值，进行航迹点的选择，最后通过连接备选的航迹点确定航迹，从而进一步缩短实际运动轨迹长度的目的。


背景技术：

2.近年来，随着相关技术的不断发展，无人机越来越广泛的应用于各行各业。其中，绝大部分应用场所都要求无人机有自主导航能力，并且在完成任务的同时能够安全的规避障碍物。无人机能够自主正常运行主要由两部分组成：一是飞控系统，二是航迹规划系统。飞控系统用来给无人机提供动力输出，使无人机在运行中有充足的动力，而航迹规划系统用来规划无人机可执行任务需求的路径，规划路径的优劣直接影响到无人机的工作效率。
3.航迹规划算法有a*算法，d*算法，模拟退火算法，遗传算法等。其中蚁群算法具有信息正反馈的优点，但在搜索航迹路径时容易陷入局部最优的特点，因此，近年来被许多学者通过改进应用到航迹规划问题上，其中提出的“零威胁-单因子”方法不仅提高了算法的收敛速度，还降低了优化时的难度；引入偏航角对启发函数进行调整改进，建立优先搜索集，加快了搜索到最优航迹的时间；通过引入去交叉禁忌搜索策略，解决在收敛后期陷入局部最优的问题；通过利用自适应调节参数方法提高蚁群搜索能力与个体之间交互能力，解决局部陷入最优的情况。


技术实现要素：

4.本发明的目的是为了解决无人机在航迹规划过程中使用蚁群算法易陷入局部最优而导致不能得到全局的最短航迹的问题，通过在算法中加入状态参数方程，并设置状态方程的阈值，通过比较求解值与阈值的大小等操作来减少实际运动轨迹长度，为了实现上述目的，本发明的步骤如下：步骤一：生成环境模拟地图，根据无人机要执行任务的环境信息进行建模，生成可执行区域的环境地图。
5.步骤二：确定已知条件中的无人机要执行任务的起始状态点与目标状态点，以及随机生成的随机障碍物在模拟地图中的体现。
6.步骤三：引入状态参数方程以及阈值，并进行状态点与周围状态点一起的三个状态点的参数方程特征值进行比较，确定可供选择的航迹状态点作为备选状态点。
7.步骤四：顺次连接备选状态点，得到规划的航迹线路，得到改进后的无人机轨迹线路图，并进行圆滑处理。
8.所述步骤一中的具体情况如下：根据无人机的活动任务建立合适的位置参考系，将模拟的地图在二维平面上满足无人机可到达的最远航行位置，并且在二维平面内用有效的坐标组确定无人机各个状态的位置，保证模拟的环境地图能够满足无人机执行算法的可操作空间。
9.所述步骤二中的具体情况如下：（1）确定无人机可执行任务的运动状态起点与状态终点：模拟地图环境中要尽可能的将无人机的轨迹布满整个环境地图，可将运动状态起始点(x
start
，y
start
)与运动状态目标点(x
goal
，y
goal
)选择在地图的上下对角线上；（2）在随机障碍生成的过程中，可设置生成random函数，使障碍物在模拟地图的环境中要保持相对独立且不相关，而且在环境地图上无规律的显示出来。
10.所述步骤三中的具体情况如下：（1）选择路径概率，每个蚂蚁都会随机的选择下一状态点，并且存储已经走过的路径状态点。蚂蚁在构建路径时的每一步中，都会按照一定的概率选择下一个到达的状态点，其中概率的计算公式为：其中表示节点i到节点j上信息素的积累量；是节点i，j之间的导数距离，也是蚁群算法中的启发因子η
ij
(t)为：η
ij
(t)＝1/d
ij
表示从节点i到节点j的期望程度，p
ijk
(t)表示第k只蚂蚁在时刻t通过两个相邻节点i到节点j的概率；表示蚂蚁未走过的节点集合；α为信息素启发因子，在算法中表征所释放信息的重要程度；β为期望启发因子，其表征能见度的重要程度；（2）信息素更新函数,其中蚁群算法中的信息素更新函数为：τ
ij
(t n)＝(1-ρ)τ
ij
(t) δτ
ij
(t)为蚂蚁个数，为信息素的蒸发系率，表示信息素残留率，δτ
ij
(t)代表时刻信息素的增量，其中：刻信息素的增量，其中：而表示表示第只蚂蚁在路径上释放的信息素量，取值范围为：其中是增强系数，是一个非零且为正数的的常量，表示第只蚂蚁走过的路径长度；（3）迭代与停止,算法中的每一次迭代表示的是每次迭代的只蚂蚁在完成自己的
路径规程，回到原点后的整个过程。迭代停止的条件是选择合适的迭代次数停止，输出寻找的最佳路径，或者是满足算法要求的迭代次数;在迭代结束后找到规划的路径，看是否是最佳路径；（4）改进算法局部最佳,针对蚁群算法易陷入局部最佳路径，借鉴象棋中“卒”的走法，设置状态参数方程进行阈值比较，假设蚂蚁的下一状态点可供选择的节点a(xa，ya)，与b(xb，yb)，设状态起始点为q(xq，yq)，当前状态点为s(xs，ys)与目标状态点为g(xg，yg)，就可确定阈值的大小为：可供选择的下一状态节点到目标节点的的距离为：可供选择的下一状态节点到目标节点的的距离为：只要通过比较参数方程得到的l
ag
、l
bg
特征值与阈值l
yu
之间进行比较，就可得到航迹规划的选用节点。
11.所述步骤四中的具体情况如下：（1）检查无人机可选择的航迹状态节点，首先确定起始状态点与目标状态点的合理性，然后依次顺着起始节点根据改进机制进行选择节点的连接，得到航迹线路图；（2）将改进后的轨迹线路图进行满足实际运动规律的平滑处理，处理后得到新的轨迹l
qg
。
12.本发明还包括这样一些特征：相比较传统的蚁群算法在进行航迹规划时，易于早期陷入局部最优从而在得到完整的航迹段时不能保持良好的规划特性轨迹，本发明针对蚁群算法易陷入局部最优问题进行了算法上的改进，改进后的轨迹长度相较于传统的路径长度减少，从而间接的减少了无人机的实际运动时间。
13.相比较其它的关于改进蚁群算法上，本发明所提出的基于改进蚁群算法的无人机航迹规划方法上，将生活中的常识应用到算法中，得到的轨迹长度相较于传统轨迹长度更短，更有助于仿真应用与实际工程需求。
附图说明
14.图1为本发明的方法流程图；图2为状态节点选择图。
具体实施方式
15.对于本领域技术人员来说，附图说明中某些公知结构及其说明可能省略是可以理解的。下面结合附图和实现步骤对本发明作进一步的描述。
16.本发明提出基于改进蚁群算法的无人机航迹规划算法对运动轨迹进行优化，通过引入状态参数方程阈值，进行航迹点的选择，最后通过连接备选的航迹点确定航迹，从而进一步缩短实际运动轨迹长度的目的。
17.图1为本发明的方法流程图，首先是生成无人机要执行任务的环境模拟地图；然后是确定无人机执行任务的起始状态点与目标状态点，以及随机生成的障碍物区域；接下来在算法中加入状态参数方程以及阈值，进行相应的特征值比较，确定状态点与周围相邻两个状态点之间到目标状态点的轨迹长度值，得到规划的航迹状态点；最后通过连接已确定的航迹轨迹点，得到改进后的无人机航迹线路图。
18.具体的实现步骤为：step1 根据无人机的活动任务建立合适的位置参考系，将模拟的地图在二维平面上满足无人机可到达的最远航行位置，并且在二维平面内用有效的坐标组确定无人机各个状态的位置，保证模拟的环境地图能够满足无人机执行算法的可操作空间。
19.step2.1 确定无人机可执行任务的运动状态起点与状态终点：模拟地图环境中要尽可能的将无人机的轨迹布满整个环境地图，可将运动状态起始点(x
start
，y
start
)与运动状态目标点(x
goal
，y
goal
)选择在地图的上下对角线上；step2.2 在随机障碍生成的过程中，可设置生成random函数，使障碍物在模拟地图的环境中要保持相对独立且不相关，而且在环境地图上无规律的显示出来。
20.step3.1 选择路径概率，每个蚂蚁都会随机的选择下一状态点，并且存储已经走过的路径状态点。蚂蚁在构建路径时的每一步中，都会按照一定的概率选择下一个到达的状态点，其中概率的计算公式为：其中表示节点i到节点j上信息素的积累量；是节点i，j之间的导数距离，也是蚁群算法中的启发因子η
ij
(t)为：η
ij
(t)＝1/d
ij
表示从节点到节点的期望程度，p
ijk
(t)表示第k只蚂蚁在时刻通过两个相邻节点到节点的概率；表示蚂蚁未走过的节点集合；为信息素启发因子，在算法中表征所释放信息的重要程度；为期望启发因子，其表征能见度的重要程度；step3.2 信息素更新函数。其中蚁群算法中的信息素更新函数为：τ
ij
(t n)＝(1-ρ)τ
ij
(t) δτ
ij
(t)为蚂蚁个数，为信息素的蒸发系率，表示信息素残留率，代表时刻信息素的增量，其中：信息素的增量，其中：
而表示表示第只蚂蚁在路径上释放的信息素量，取值范围为：其中是增强系数，是一个非零且为正数的的常量，表示第只蚂蚁走过的路径长度；step3.3 迭代与停止。算法中的每一次迭代表示的是每次迭代的只蚂蚁在完成自己的路径规程，回到原点后的整个过程。迭代停止的条件是选择合适的迭代次数停止，输出寻找的最佳路径，或者是满足算法要求的迭代次数。在迭代结束后找到规划的路径，看是否是最佳路径；step3.4 改进算法局部最佳。针对蚁群算法易陷入局部最佳路径，借鉴象棋中“卒”的走法，设置状态参数方程进行阈值比较，假设蚂蚁的下一状态点可供选择的节点a(xa，ya)，与b(xb，yb)，设状态起始点为q(xq，yq)，当前状态点为s(xs，ys)与目标状态点为g(xg，yg)，就可确定阈值的大小为：可供选择的下一状态节点到目标节点的的距离为：可供选择的下一状态节点到目标节点的的距离为：只要通过比较参数方程得到的l
ag
、l
bg
特征值与阈值l
yu
之间进行比较，就可得到航迹规划的选用节点。
21.step4.1 检查无人机可选择的航迹状态节点，首先确定起始状态点与目标状态点的合理性，然后依次顺着起始节点根据改进机制进行选择节点的连接，得到航迹线路图；step4.2 将改进后的轨迹线路图进行满足实际运动规律的平滑处理，处理后得到新的轨迹l
qg
。
22.图2为状态节点选择图。蚁群算法在进行航迹规划时是仿照蚂蚁进行觅食所释放的激素寻找路径的，会导致在某些节点出现激素积累高而失去选择最优路径的机会，通过引入状态参数方程与阈值，进行特征值比较，选择合理的状态节点，能够很好的克服局部最优解问题，从而得到实际运动距离更短的轨迹线路。