一种地磁多参量多目标快速收敛的仿生导航方法技术

本发明专利技术提出一种地磁多参量多目标快速收敛的仿生导航方法，以终点地磁场多参量为目标值，在没有先验地磁图的情况下，进行高效、快速的路径搜索。首先获取载体当前时刻所处位置及目的地的地磁参量信息；根据当前位置及目的地的地磁信息构建损失函数，通过对损失函数的观测来判断载体是否到达目标位置，若到达则完成导航，否则依据相应的搜索策略进行最优行进角的确定，按照预设步长进行载体的位置更新，并循环以上步骤，直至完成导航过程。较现有的时序进化搜索方法减少了行进过程中的随机性，避免了无序的搜索过程，提高导航效率。

A bionic navigation method with fast convergence of geomagnetic multi parameters and multi targets

【技术实现步骤摘要】
一种地磁多参量多目标快速收敛的仿生导航方法
本专利技术适用于无先验地磁场的情况下，以终点地磁场多参量为目标值，实现水下潜航器长航时地磁自主导航，特别是涉及一种地磁多参量多目标快速收敛的仿生导航方法。
技术介绍
地磁导航的物理基础是近地空间内地磁环境与空间位置具有一一对应的关系，由此而引发的地磁导航研究已成为自主导航领域研究的热点方向。目前，地磁导航主要以匹配方式为代表，利用实测地磁数据串与先验地磁图进行相关匹配来获取载体位置，对地磁图的完整度、精确度要求极高。然而，由于种种原因，先验地磁图绘制时的精确性与完整性无法保证。近年来种种研究表明，地球上许多生物都可以根据地球磁场信息来进行定位和导航。生物磁趋势性敏感不仅为导航路径明确的生物(如大雁、知更鸟等)提供方向辨识，同时也为主动搜寻式的生物(如信鸽、海龟等)提供导航信息。因此，可在无先验地磁场的情况下，以终点地磁场多参量为目标值，将多目标的求解与导航运动相结合，构建一种仿生地磁导航方法。从生物磁趋势性敏感角度看，地磁场是多种参量的混合体，仿生地磁导航则可看作是在多种磁场参量刺激下进行的搜索运动行为。在以终点地磁场多参量为目标值的搜索导航过程中，运动路径既是搜索的结果，同时运动路径引起的多种参量变化也是诱使导航搜索不断进行的原因。载体如何依靠地磁参量信息准确快速的到达目标位置，是目前重点研究方向之一。有效的行进方向角能够提高无人载体的导航效率，使导航路径更加可靠与准确。根据生物运动行为与地磁场变化趋势性敏感的特性，研究磁参量变化与行进方向角之间的关系，建立地磁多参量变化与方向角的函数关系模型，从而摆脱无序，随机游走的搜索模式，使得无人载体在没有先验地磁图的情况下，快速、高效的到达目标位置。
技术实现思路
为了解决以上问题，本专利技术提供一种地磁多参量多目标快速收敛的仿生导航方法，在无先验地磁图的情况下，以目的地的地磁多参量为目标值，结合当前位置及周围一定区域的地磁参量信息，对最优前进方向角进行预测，引导载体不断向目标点运动，最终完成导航，为达此目的，本专利技术提供一种地磁多参量多目标快速收敛的仿生导航方法，其特征在于，包括：步骤1：获取载体当前时刻所处位置及目标位置的地磁参量；步骤2：判断是否到达目的地：根据当前位置与目的地的地磁参量构建损失函数，通过计算当前的损失函数来判断载体是否到达目的地，若到达目的地，停止搜索完成导航；否则跳转至步骤3；步骤3：依据搜索策略对最优行进角进行预测：载体行进过程中，若相邻两时刻的磁场矢量的变化方向与目的地和当前位置的地磁矢量变化方向一致时，则满足多参量同时同地收敛的条件。依据上述原则进行最优行进角的确定，重复上述步骤，直到完成导航。本专利技术的进一步改进，所述的磁场参量元素包括磁场三分量、磁场总强度、磁场水平分量、磁偏角、磁倾角中的部分或全部，所述磁场三分量，分别为北向分量、东向分量、垂直分量。本专利技术的进一步改进，步骤2中所述的第i个地磁参量的损失函数为：其中与分别k时刻载体位置与目的地的第i个地磁参量信息。通过观察当前的损失函数来判断载体是否到达目的地。考虑地磁参量间的量级和单位，对损失函数进行归一化处理，得：其中，分别为载体初始位置和目的地的第i个地磁参量信息，当载体行进至目的地时，损失函数值理论上为0，因此，当前位置磁参量的损失函数值较小时，即满足F(Bk)≤ε,可认为导航器到达目的地，其中ε为接近0的极小量，根据导航精度进行设定。本专利技术的进一步改进，步骤3中所述的搜索策略满足时即有：(Baim-Bk)//(Bk+1-Bk)其中，Bk，Bk+1，Baim分别表示k时刻、k+1时刻及目的地地磁参量，当满足以上条件时，向量(Baim-Bk)与(Bk+1-Bk)之间的夹角为0，因此，分别计算当前位置和四周的邻近位置地磁信息的差值向量，与目标点和当前位置的地磁信息差值向量之间的夹角，取夹角最小时的行进角为最优行进方向，并沿其运动预设步长。本专利技术的进一步改进，所述邻近位置的分布为以当前点为圆心对行进角进行离散采样，表示为：θ＝{θ1,θ2,…,θM}，其中，Iθ为采样间隔，θi＝i×Iθ，根据导航精度调整采样间隔。本申请一种地磁多参量多目标快速收敛的仿生导航方法，本专利技术与现有技术相比的优点在于：依据本申请提供的地磁仿生导航算法，无需依赖先验地磁图，依据搜索策略不断调整最优行进方向，快速、高效的完成导航路径搜寻。较现有的时序进化搜索方法减少了行进过程中的随机性，利用载体当前时刻的多个磁参量信息，选择最优的前进航向角，避免了无序的搜索过程，以及多参量同时估计，可以使得多目标参量同时快速收敛至目标位置。附图说明图1为本申请导航方法流程图；图2为本申请搜索策略示意图；图3为本申请实施例的导航路径示意图；图4为本申请实施例的选取参量元素收敛示意图。具体实施方式下面结合附图对本专利技术进一步详细说明。地磁场包含多个地磁特征量，从仿生角度出发，生物运动行为具有对地磁场变化趋势性敏感的特性，因此，地磁仿生导航的过程可视为是地磁场多个特征参量从起始位置对目标位置的各个特征参量搜索收敛的过程，如图1所示实现方法具体步骤如下：1)载体运动模型建立在水下潜航器基于地磁参量的仿生导航过程中，可将潜航器视为质点，其运动方程可表示为：其中，(xk,yk)、(xk+1,yk+1)分别表示k与k+1时刻潜航器的位置，θk为k时刻载体航向角，v为载体运动速度，u为系统的输入，与潜航器的航向角θ与速度v有关。假定航行器在ΔT内进行匀速运动，则v可以用常量V表示，则上式简化为:其中，L表示运动步长，L＝ΔT×V。2)初始化获取载体初始时刻与目的地的地磁参量信息，设置载体运动步长；3)判断是否到达终点当前位置的地磁参量环境可描述为：B＝{B1,B2,…Bn}其中，B1,B2,…Bn为地磁场各参量元素，可以是磁场三分量(地磁北向分量、地磁东向分量、地磁垂直分量)、磁场总强度、磁偏角、磁倾角、磁场水平分量等参量中的部分或全部。根据当前位置与目的地的地磁信息构建第i个地磁参量的损失函数为：其中与分别k时刻载体位置与目的地的第i个地磁参量信息。通过观察当前的损失函数来判断载体是否到达目的地。考虑地磁参量间的量级和单位，对损失函数进行归一化处理，得：其中，分别为载体初始位置和目的地的第i个地磁参量信息，当载体行进至目的地时，损失函数值理论上为0，因此，当前位置磁参量的损失函数值较小时，即满足F(Bk)≤ε,可认为导航器到达目的地，其中ε为接近0的极小量，根据导航精度进行设定。若不满足以上条件跳转至下一步。4)最优行进角的确定如图1所示，载体行进过程中，为避免无序的搜索过程，实现多参量同时同地收敛，使则下一步的行进方向尽量满足：(Baim-Bk)//(Bk+1-本文档来自技高网...

【技术保护点】
1.一种地磁多参量多目标快速收敛的仿生导航方法，其特征在于，包括：/n步骤1：获取载体当前时刻所处位置及目标位置的地磁参量；/n步骤2：判断是否到达目的地：根据当前位置与目的地的地磁参量构建损失函数，通过计算当前的损失函数来判断载体是否到达目的地，若到达目的地，停止搜索完成导航；否则跳转至步骤3；/n步骤3：依据搜索策略对最优行进角进行预测：载体行进过程中，若相邻两时刻的磁场矢量的变化方向与目的地和当前位置的地磁矢量变化方向一致时，则满足多参量同时同地收敛的条件。依据上述原则进行最优行进角的确定，重复上述步骤，直到完成导航。/n

【技术特征摘要】
1.一种地磁多参量多目标快速收敛的仿生导航方法，其特征在于，包括：
步骤1：获取载体当前时刻所处位置及目标位置的地磁参量；
步骤2：判断是否到达目的地：根据当前位置与目的地的地磁参量构建损失函数，通过计算当前的损失函数来判断载体是否到达目的地，若到达目的地，停止搜索完成导航；否则跳转至步骤3；
步骤3：依据搜索策略对最优行进角进行预测：载体行进过程中，若相邻两时刻的磁场矢量的变化方向与目的地和当前位置的地磁矢量变化方向一致时，则满足多参量同时同地收敛的条件。依据上述原则进行最优行进角的确定，重复上述步骤，直到完成导航。


2.根据权利要求1所述的一种地磁多参量多目标快速收敛的仿生导航方法，其特征在于：所述的磁场参量元素包括磁场三分量、磁场总强度、磁场水平分量、磁偏角、磁倾角中的部分或全部，所述磁场三分量，分别为北向分量、东向分量、垂直分量。


3.根据权利要求1所述的一种地磁多参量多目标快速收敛的仿生导航方法，其特征在于：步骤2中所述的第i个地磁参量的损失函数为：



其中与分别k时刻载体位置与目的地的第i个地磁参量信息。通过观察当前的损失函数来判断载体是否到达目的地。考虑地磁参量间的量...

【专利技术属性】
技术研发人员：张涛，张佳宇，张晨，张江源，夏茂栋，王健，朱永云，张亮，魏宏宇，张硕骁，
申请(专利权)人：东南大学，
类型：发明
国别省市：江苏;32