[发明专利]一种地磁多参量多目标快速收敛的仿生导航方法

说明书

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

技术领域

本发明适用于无先验地磁场的情况下，以终点地磁场多参量为目标值，实现水下潜航器长航时地磁自主导航，特别是涉及一种地磁多参量多目标快速收敛的仿生导航方法。

背景技术

地磁导航的物理基础是近地空间内地磁环境与空间位置具有一一对应的关系，由此而引发的地磁导航研究已成为自主导航领域研究的热点方向。目前，地磁导航主要以匹配方式为代表，利用实测地磁数据串与先验地磁图进行相关匹配来获取载体位置，对地磁图的完整度、精确度要求极高。然而，由于种种原因，先验地磁图绘制时的精确性与完整性无法保证。近年来种种研究表明，地球上许多生物都可以根据地球磁场信息来进行定位和导航。生物磁趋势性敏感不仅为导航路径明确的生物(如大雁、知更鸟等)提供方向辨识，同时也为主动搜寻式的生物(如信鸽、海龟等)提供导航信息。因此，可在无先验地磁场的情况下，以终点地磁场多参量为目标值，将多目标的求解与导航运动相结合，构建一种仿生地磁导航方法。

从生物磁趋势性敏感角度看，地磁场是多种参量的混合体，仿生地磁导航则可看作是在多种磁场参量刺激下进行的搜索运动行为。在以终点地磁场多参量为目标值的搜索导航过程中，运动路径既是搜索的结果，同时运动路径引起的多种参量变化也是诱使导航搜索不断进行的原因。载体如何依靠地磁参量信息准确快速的到达目标位置，是目前重点研究方向之一。有效的行进方向角能够提高无人载体的导航效率，使导航路径更加可靠与准确。根据生物运动行为与地磁场变化趋势性敏感的特性，研究磁参量变化与行进方向角之间的关系，建立地磁多参量变化与方向角的函数关系模型，从而摆脱无序，随机游走的搜索模式，使得无人载体在没有先验地磁图的情况下，快速、高效的到达目标位置。

发明内容

为了解决以上问题，本发明提供一种地磁多参量多目标快速收敛的仿生导航方法，在无先验地磁图的情况下，以目的地的地磁多参量为目标值，结合当前位置及周围一定区域的地磁参量信息，对最优前进方向角进行预测，引导载体不断向目标点运动，最终完成导航，为达此目的，本发明提供一种地磁多参量多目标快速收敛的仿生导航方法，其特征在于，包括：

步骤1：获取载体当前时刻所处位置及目标位置的地磁参量；

步骤2：判断是否到达目的地：根据当前位置与目的地的地磁参量构建损失函数，通过计算当前的损失函数来判断载体是否到达目的地，若到达目的地，停止搜索完成导航；否则跳转至步骤3；

步骤3：依据搜索策略对最优行进角进行预测：载体行进过程中，若相邻两时刻的磁场矢量的变化方向与目的地和当前位置的地磁矢量变化方向一致时，则满足多参量同时同地收敛的条件。依据上述原则进行最优行进角的确定，重复上述步骤，直到完成导航。

本发明的进一步改进，所述的磁场参量元素包括磁场三分量、磁场总强度、磁场水平分量、磁偏角、磁倾角中的部分或全部，所述磁场三分量，分别为北向分量、东向分量、垂直分量。

本发明的进一步改进，步骤2中所述的第i个地磁参量的损失函数为：

其中与分别k时刻载体位置与目的地的第i个地磁参量信息。通过观察当前的损失函数来判断载体是否到达目的地。考虑地磁参量间的量级和单位，对损失函数进行归一化处理，得：