基于声学测量网络的水下多AUV协同定位编队拓扑结构优化方法技术

本发明专利技术属于声学测量领域，具体涉及一种基于声学测量网络的水下多AUV协同定位编队拓扑结构优化方法。本发明专利技术在多随从AUV情况下，考虑了声学测距误差与距离的相关性，具有更高的实用价值；针对位置信息的不确定性，根据相应的概率密度采用蒙特卡洛方法对可能分布区域内的编队构型进行优化设计；采用基于退火思想的步进递推的策略，不管主艇初始位置在何处，均可经过迭代步骤找到其最优位置布局；本发明专利技术引入Metropolis准则作为判断是否接受新解作为当前解的准则之一，可有效改善当局部最优解出现时迭代不再继续进行的情况；本发明专利技术的迭代过程产生新解邻域的大小与温度高低直接相关，增加最终结果的精确性。

Topology optimization method of underwater multi-AUV cooperative positioning formation based on acoustic measurement network

The invention belongs to the field of acoustic measurement, in particular to an optimization method of underwater multi-AUV coordinated positioning formation topology structure based on acoustic measurement network. In the case of MULTI-FOLLOWER AUV, considering the correlation between acoustic ranging error and distance, the present invention has higher practical value; aiming at the uncertainty of position information, the formation configuration in the possible distribution area is optimized by Monte Carlo method according to the corresponding probability density; and the step-by-step recursive strategy based on annealing is adopted, regardless of the initial position of the main ship. The present invention introduces Metropolis criterion as one of the criteria for judging whether to accept a new solution as the current solution, which can effectively improve the situation that the iteration does not continue when the local optimal solution appears; the size of the neighborhood of the new solution generated by the iteration process of the present invention is directly related to the temperature and increases the accuracy of the final result.

【技术实现步骤摘要】
基于声学测量网络的水下多AUV协同定位编队拓扑结构优化方法
本专利技术属于声学测量领域，具体涉及一种基于声学测量网络的水下多AUV协同定位编队拓扑结构优化方法。
技术介绍
协同定位是目前中间层区域多自主式水下航行器最有效的导航方法之一。航行器编队拓扑结构会对整个系统的可观测性产生直接影响，从而影响多自主水下航行器协同定位精度。因此，考虑水声测距误差与距离的相关性，对协同定位系统的编队拓扑结构进行优化，使系统的可观测性达到最优，是协同定位方向需要深入研究的课题。目前针对多领航、多随从AUV系统，多采用Fisher信息矩阵推导评价函数，采取基于偏导数的梯度算法进行位置的迭代。然而，该方法的求解过程依赖于初始位置的选取，若初始位置选取不当，往往存在陷入局部最优解的危险，而无法得到最优拓扑结构。本专利技术考虑和距离相关的水声噪声，采用引入退火思想的步进递推策略对多AUV协同定位系统的最优编队拓扑构型的优化方法进行了研究。现在常用的令对随从AUV取Fisher信息矩阵的行列式作为评价函数的方法，在AUV编队规模日益扩大的情况很难通过计算机解算得到最优编队拓扑结构；基于偏导数的迭代策略虽然可以在一定程度上避免多解或无解情况的产生，但在初始位置选取不当时往往受限于局部最优解而无法得到真正最优的拓扑结构。针对目前在设计多AUV协同定位系统编队构型的求解困难的问题，本专利技术在基于Fisher信息矩阵理论的基础上，综合考虑多随从AUV、随从AUV位置不确定以及与距离相关的水声噪声来推导评价函数，提出一种基于退火思想的步进递推策略，最终实现快速递推得到最优编队拓扑结构。本专利技术可用于多AUV协同定位系统的编队构型优化领域。
技术实现思路
本专利技术的目的在于提供一种能够在随从AUV位置不确定情形下，领航AUV从任意初始位置出发，完成多AUV协同定位系统编队构型快速优化设计的方法。本专利技术的目的是这样实现的：基于声学测量网络的水下多AUV协同定位编队拓扑结构优化方法，该方法包括以下步骤：步骤1：建立多AUV协同定位模型；步骤2：推算各随从AUV的Fisher信息矩阵；步骤3：根据各随从AUV的Fisher信息矩阵，构建系统评价函数；步骤4：根据系统评价函数，计算最优编队拓扑结构约束条件；步骤5：引入退火思想完成步进递推过程；步骤5.1：初始化；步骤5.2：在邻域内产生新解；步骤5.3：通过得到的新的领航AUV的位置参数xinew和yinew计算最优评价函数Fnew；步骤6：根据约束条件验证最终编队拓扑结构，找到最优位置布局。本专利技术还包括：步骤1所述的多AUV协同定位模型为：(i＝1,2,3...n，j＝1,2,3,...m)式中，rij为第i个领航AUV与第j个随从AUV之间的真实距离；lij为第i个领航AUV与第j个随从AUV之间的量测距离；pi＝[xi,yi,zi]T为第i个领航AUV在导航坐标系中的位置，xi为第i个领航AUV在x轴方向的坐标，yi为第i个领航AUV在y轴方向的坐标，zi为第i个领航AUV在z轴方向的坐标；qj＝[xj,yj,zj]T为第j个随从AUV在导航坐标系中的位置，xj为第j个随从AUV在x轴方向的坐标，yj为第j个随从AUV在y轴方向的坐标，zj为第j个随从AUV在z轴方向的坐标；n为领航AUV的数目，m为ωij为随从AUV的数目；噪声信号，且ωij＝σ(1+ηrijγ)，σ为量测噪声常数；η为量测噪声相关的常数，γ为距离相关的常数。步骤2所述的推算各随从AUV的Fisher信息矩阵为：式中：向量步骤3所述的系统评价函数表达式为：式中：f(qj)为概率密度函数，其具体形式会根据随从AUV的工作任务决定；Dj为随从AUV可能分布的范围，根据概率密度函数决定，用蒙特卡洛方法化简为如下形式：式中，第一参数Aijv、第二参数Bijv、第三参数Mijv表示为：jυ为一定区域内，第υ个可能的随从AUV位置，在该域内根据构建的可观测性评价函数，解得从艇j的最优位置。步骤4所述的计算最优编队拓扑结构约束条件为：用蒙特卡洛方法化简成如下形式：步骤5.1所述的初始化包括以下步骤：(5.1.1)初始化温度T；(5.1.2)初始化解状态；(5.1.3)初始化每个T值时的迭代次数k；对每一个随从AUV来说，通过当前各个领航AUV的横坐标xi和纵坐标yi计算其Fisher信息矩阵的行列式|FIM(qj)|，之后将Fisher信息矩阵的行列式取对数并求和，即得到在当前步骤的评价函数，记为F[t]，作为初始化的解状态；其中温度下降率趋于1。步骤5.3所述计算最优评价函数Fnew，之后会产生两种情况：情况1：Fnew＞Fold，则说明新的领航AUV位置能够提升系统的可观测性，将新的领航AUV编队拓扑结构作为基础，回到步骤2进行下一步计算；情况2：Fnew＜Fold，则说明新的领航AUV位置不一定能够提升系统的可观测性，此时不能排除局部最优解的情况，因此以Metropolis准则接受新解作为当前解，同样回到步骤2进行下一步计算；计算得到新的最优评价函数Fnew导致温度变化，使得领航AUV的位置参数发生变化如下式所示：xi_new＝xi_old+μ·Tyi_new＝yi_old+μ·T其中，μ可选择为(-1,1)上任意一个常数，此时产生新解的邻域的大小与温度高低直接相关，随着温度的降低，产生新解的邻域范围逐渐缩小。本专利技术的有益效果在于：1.本专利技术在多随从AUV情况下，考虑了声学测距误差与距离的相关性，具有更高的实用价值；2.本专利技术针对位置信息的不确定性，根据相应的概率密度采用蒙特卡洛方法对可能分布区域内的编队构型进行优化设计，针对实际中可能出现的问题有较好的应对方案；3.本专利技术采用基于退火思想的步进递推的策略，递推过程的进行与初始值的选取无关，也就是说，不管主艇初始位置在何处，均可经过迭代步骤找到其最优位置布局；4.本专利技术引入Metropolis准则作为判断是否接受新解作为当前解的准则之一，可有效改善当局部最优解出现时迭代不再继续进行的情况，是一种以概率l收敛于全局最优解的全局优化算法；5.本专利技术的迭代过程产生新解邻域的大小与温度高低直接相关，随着温度的降低，产生新解的邻域逐渐缩小至一个极小的范围，这样可以在递推的过程中逐步减小领航AUV位置递推移动的距离，增加最终结果的精确性。附图说明图1为本专利技术的流程图。图2为随从AUV位置不确定时交叉计算示意图。图3为角度投影示意图。具体实施方式下面结合附图对本专利技术做进一步描述：步骤一：建立多AUV协同定位模型；建立多AUV协同定位模型时，采用的模型为：式中：ωij＝σ(1+ηrijγ),(i＝1,2,3...n，j＝1,2,3,...m)lij为第i个领航AUV与第j个随从AUV之间的量测距离；pi＝[xi,yi,zi]T为第i个领航AUV在导航坐标系中的位置；qj＝[xj,yj,zj]T为第j个随从AUV在导航坐标系中的位置；ωij为噪声信号；rij为第i个领航AUV与第j个随从AUV之间的真实距离；σ为量测噪声常数；η和γ均为量测噪声和距离相关的常数。步骤二：推算各随从AUV的Fisher信息矩阵；推算各随从AUV的Fisher信息矩阵时，采用的算法模型为：式中：步骤三：推导系统评价函数表达式本文档来自技高网...

【技术保护点】
1.基于声学测量网络的水下多AUV协同定位编队拓扑结构优化方法，其特征在于，该方法包括以下步骤：步骤1：建立多AUV协同定位模型；步骤2：推算各随从AUV的Fisher信息矩阵；步骤3：根据各随从AUV的Fisher信息矩阵，构建系统评价函数；步骤4：根据系统评价函数，计算最优编队拓扑结构约束条件；步骤5：引入退火思想完成步进递推过程；步骤5.1：初始化；步骤5.2：在邻域内产生新解；步骤5.3：通过得到的新的领航AUV的位置参数xinew和yinew计算最优评价函数Fnew；步骤6：根据约束条件验证最终编队拓扑结构，找到最优位置布局。

【技术特征摘要】
1.基于声学测量网络的水下多AUV协同定位编队拓扑结构优化方法，其特征在于，该方法包括以下步骤：步骤1：建立多AUV协同定位模型；步骤2：推算各随从AUV的Fisher信息矩阵；步骤3：根据各随从AUV的Fisher信息矩阵，构建系统评价函数；步骤4：根据系统评价函数，计算最优编队拓扑结构约束条件；步骤5：引入退火思想完成步进递推过程；步骤5.1：初始化；步骤5.2：在邻域内产生新解；步骤5.3：通过得到的新的领航AUV的位置参数xinew和yinew计算最优评价函数Fnew；步骤6：根据约束条件验证最终编队拓扑结构，找到最优位置布局。2.根据权利要求1所述的基于声学测量网络的水下多AUV协同定位编队拓扑结构优化方法，其特征在于，步骤1所述的多AUV协同定位模型为：式中，rij为第i个领航AUV与第j个随从AUV之间的真实距离；lij为第i个领航AUV与第j个随从AUV之间的量测距离；pi＝[xi,yi,zi]T为第i个领航AUV在导航坐标系中的位置，xi为第i个领航AUV在x轴方向的坐标，yi为第i个领航AUV在y轴方向的坐标，zi为第i个领航AUV在z轴方向的坐标；qj＝[xj,yj,zj]T为第j个随从AUV在导航坐标系中的位置，xj为第j个随从AUV在x轴方向的坐标，yj为第j个随从AUV在y轴方向的坐标，zj为第j个随从AUV在z轴方向的坐标；n为领航AUV的数目，m为ωij为随从AUV的数目；噪声信号，且ωij＝σ(1+ηrijγ)，σ为量测噪声常数；η为量测噪声相关的常数，γ为距离相关的常数。3.根据权利要求2所述的基于声学测量网络的水下多AUV协同定位编队拓扑结构优化方法，其特征在于，步骤2所述的推算各随从AUV的Fisher信息矩阵为：式中：向量4.根据权利要求3所述的基于声学测量网络的水下多AUV协同定位编队拓扑结构优化方法，其特征在于，步骤3所述的系统评价函数表达式为：式中：f(qj)为概率密度函数，其具体形式会根据随从AUV的工作任务决定...

【专利技术属性】
技术研发人员：徐博，王潇雨，李盛新，郜中星，张娇，金坤明，刘斌，李珊珊，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23