一种多UUV仿生协同导航方法与流程

本发明为一种多uuv仿生协同导航方法，将导航过程归结为多目标搜索问题，通过共享uuv间的各向磁场强度信息，完成协同导航任务

背景技术：

对多uuv精确导航问题的研究已经变得非常迫切。卫星导航系统的信号在水下严重衰减，高精度的惯性导航系统价格昂贵，而且误差随时间积累，因此有必要寻找全域的自然源导航手段作为深海探测的重要保障，而地磁场恰恰具有这样的导航特点。目前，地磁导航主要是以匹配方式为代表，利用实时测得的地磁数据与先验地磁图进行匹配，获取载体当前的位置。对先验地磁图的依赖是制约地磁导航发展的关键，建立有效完整的先验地磁图在目前看来是非常困难的。

在水下无卫星信号，且仅使用低精度惯导，导致定位误差随时间积累，无法到达指定目标地点，遂提出利用仿生协同导航方法针对多uuv进行协同导航，在各uuv间实现信息共享，提高搜索效率，最终达到目标地点。从仿生学角度入手对该问题进行研究，并且提出了利用粒子群算法进行导航的多目标搜索方法，完成在未知地磁环境下的导航任务。

技术实现要素：

本发明的目的是提供一种基于粒子群算法的多uuv仿生协同导航方法，在水下无卫星信号时可以满足导航精度要求。

本发明是通过以下技术方案实现的：

步骤一:建立每个uuv的运动方程，并确定目标地点的磁场信息；

步骤二:测量每个uuv所处位置的水平北向磁场强度x、水平东向磁场强度y、垂直磁场强度z；

步骤三:计算每个uuv的目标函数值；

步骤四:利用粒子群算法计算每个uuv的速度，并按此速度更新各uuv的位置，重复步骤二到步骤四，直到到达目标地点为止。

有益效果：采用多uuv仿生协同导航方法可以弥补没有卫星信号情况下随时间积累的惯导定位误差，仅需掌握目标地点的磁场信息，就可以准确到达目标地点。

附图说明

图1为用本发明方法进行仿真得到的uuv轨迹图。

图2为用本发明方法进行仿真得到的uuv轨迹局部放大图。

图3为用本发明方法进行仿真得到的使用惯导系统定位时多uuv平均位置与目标地点的距离示意图。

图4为用本发明方法进行仿真得到的惯导系统定位时多uuv平均位置与目标地点的距离局部放大图。

图5为用本发明方法进行仿真得到的仿生协同导航时多uuv平均位置与目标地点的距离示意图。

具体实施方式

当n艘uuv进行仿生协同导航时，导航方法如下：

1.初始化目的地，uuv个数n及初始位置，适应度阈值σ，采样周期δt，并随机设置各个粒子的速度和(随机数范围根据uuv速度上限确定)；第i个uuv的速度在x，y方向上的上限分别为和那么初始速度可以由下式确定：

2.计算各uuv的优化函数

并初始化个体极值

通过下面算法确定全局极值：

3.根据粒子群优化算法公式来更新各粒子的速度，并通过下式计算uuv的航速和航向：

4.重新计算各uuv的适应度，计算新的个体极值：

将当前时刻的各个uuv适应度与现有个体极值pbest进行比较，如果比现有个体极值pbest的适应度更小，则将当前位置设置为该个体新的个体极值pbest；

5.计算当前时刻的全局极值gbest：

将每个uuv的个体极值pbest与全局极值gbest逐一比较，如果适应度更小，则为新的gbest；

6.判断全局极值gbest的适应度是否小于阈值，如果满足条件，则终止循环，认为到达目的地，若不满足，则跳到步骤3。

本发明的效果通过如下方法得到验证：

参照文献“1950—1980年中国地区主磁场模型的建立及分析”模拟实际地磁场环境，在matlab中进行仿真验证。

选取地磁场x方向分量x、y方向分量y、z方向分量z作为导航线索，分别对应(f1，f2，f3)各搜索子目标。仿真中有9艘uuv参与协同导航，取惯性因子ω＝0.7298，学习因子c1＝c2＝1.4962。

在不考虑量测噪声的情况下，进行了如下实验：随机选取初始位置(东经91°，北纬48°)，向既定地磁环境目标位置(东经105°，北纬35°)运动。每艘uuv的惯导系统的陀螺零漂均为0.01°/h，随机漂移为0.03°，首先使用惯导系统导航，当惯导系统到达“目标地点”后，由于惯导系统误差随时间的积累导致与真实的目标地点之间有很大误差，这时使用协同仿生导航方法进行精确的定位，使多uuv准确到达目的地。图3、图4、图5中纵坐标单位为m，仿真结果如附图所示，从图4可以看出，在惯导结束时，各uuv与目标地点有很大距离，经过仿生协同导航后，误差有显著减小，验证了本方法的有效性。