[发明专利]一种广义最小误差熵卡尔曼的水下无人航行器定位方法

说明书

本发明提供了一种广义最小误差熵卡尔曼的水下无人航行器定位方法，包括以下步骤：S1、采集水下无人航行器的位置和速度数据，构建为定位数据样本集；S2、采用广义最小误差熵卡尔曼滤波对定位数据样本集中定位数据样本进行滤波处理，得到修正定位数据；本发明解决了现有针对非高斯噪声的滤波方法只能处理某些特定类型的噪声，非高斯噪声无法被完全滤除，造成水声定位的估计精度低的问题。

技术领域

本发明涉及无人航行器定位技术领域，具体而言，涉及一种广义最小误差熵卡尔曼的水下无人航行器定位方法。

背景技术

随着海洋勘探的发展，水下无人航行器的应用也愈加广泛，同时水下无人航行器的高精度水声定位技术正在吸引更多的关注。在一个实际的海洋环境中，水下无人航行器的水声定位系统往往使用声波信号来进行测量和定位，但是由于复杂的水下环境以及来往船舶产生的噪声干扰，通常会导致水下无人航行器的水声定位系统产生异常测量。而由海洋环境和过往船舶产生的噪声一般都属于非高斯噪声，这些未知分布的非高斯噪声会严重影响无人航行器水声定位系统的精度，对水下无人航行器定位造成极大的负面影响。

现有进行水声定位常用的原始卡尔曼滤波算法(KF)只适用于高斯噪声条件。为了解决非高斯噪声对状态估计(水声定位)的影响：(1)最近，信息理论学习(ITL)中的最大相关熵准则(MCC)考虑了高阶统计量，是一种很好的非高斯噪声状态估计(水声定位)方法，并提出了一种新的基于MCC的KF算法，称为最大相关熵KF(MCKF)，该方法也扩展到非线性系统的状态估计(水声定位)。此外，还开发了一些基于修正的相关熵准则的KF。(2)ITL中的最小误差熵(MEE)准则在处理具有多峰分布的复杂非高斯噪声方面优于MCC。为了进一步提高KF算法处理非高斯噪声的能力，提出了一些基于MEE准则的新型卡尔曼滤波算法。然而，无论是MCC还是MEE，其误差熵的形状都不能自由改变，因为它的核函数是高斯函数，这使得基于最大相关熵和误差熵的算法只能处理某些特定类型的噪声。这些分布未知的非高斯噪声将不可避免地降低系统水声定位的估计精度。

发明内容

针对现有技术中的上述不足，本发明提供的一种广义最小误差熵卡尔曼的水下无人航行器定位方法解决了现有针对非高斯噪声的滤波方法只能处理某些特定类型的噪声，非高斯噪声无法被完全滤除，造成水声定位的估计精度低的问题。

为了达到上述发明目的，本发明采用的技术方案为：一种广义最小误差熵卡尔曼的水下无人航行器定位方法，包括以下步骤：

S1、采集水下无人航行器的位置和速度数据，构建为定位数据样本集；

S2、采用广义最小误差熵卡尔曼滤波对定位数据样本集中定位数据样本进行滤波处理，得到修正定位数据。

进一步地，所述步骤S2包括以下分步骤：

S21、将定位数据样本初始值带入预测方程，得到定位数据样本预测值；

S22、根据定位数据样本预测值和定位数据样本集中定位数据样本，计算定位数据样本误差值；

S23、根据定位数据样本误差值和增广噪声矩阵，计算增广噪声矩阵的协方差矩阵的分量；

S24、根据增广噪声矩阵的协方差矩阵的分量和定位数据样本预测值，构建广义最小误差熵卡尔曼滤波模型；

S25、根据广义最小误差熵卡尔曼滤波模型，对估计定位数据样本进行更新，得到更新估计定位数据样本；

S26、判断更新估计定位数据样本是否满足误差条件，若是，则更新估计定位数据样本为修正定位数据，若否，直接跳转至步骤S25中。

进一步地，所述步骤S21中预测方程为：