[发明专利]一种基于最小二乘法的速度信息野值剔除方法

说明书

技术领域

本发明涉及的是一种速度信息野值剔除方法。

背景技术

在实际工程应用中，由于量测系统或者数据传输等方面的原因，会导致在量测数据中出现野值，其数值与实际量测值往往相差较大，如果不经甄别直接应用于卡尔曼滤波进行当前状态值的修正，不仅无法修正状态估计存在的误差，反而会造成滤波系统不稳定，滤波结果和真实状态会出现较大偏差，严重时将导致滤波发散。因此，对量测信息进行预处理，可减小由野值引起的定位误差和滤波发散。

对于速度信息，AUV等载体机动性弱，加速度小，通常以某一稳定速率匀速运行，速率值表现为在某一固定值附近抖动，野值通常产生于传输过程产生的错误值，可以把速度信息的相继观测点看作是连续变化的，结合统计学模型，使用数据的合理性检验准则进行野值剔除。

发明内容

本发明的目的在于提供一种能够解决传输过程产生的速度错误值的剔除问题的基于最小二乘法的速度信息野值剔除方法。

本发明的目的是这样实现的：

首先设信任度为N，再按如下步骤执行，

步骤一、获得目标当前时刻之前的4个时刻的速度量测值；

步骤二、使用最小二乘算法外推出下一时刻的速度估计量；

步骤三、判断速度量测值与速度估计量的差值是否满足条件，若满足则速度量测值被接受，否则利用速度估计量代替速度量测值；

步骤四、当连续接收速度估计量的次数超过信任度N，重新建立滤波。

本发明还可以包括：

1、所述目标当前时刻之前的4个时刻的速度量测值分别表示为v(k-1)、v(k-2)、v(k-3)和v(k-4)。

2、所述使用最小二乘算法外推出下一时刻的速度估计量具体包括：下一时刻的速度估计量结合速度历史信息使用最小二乘算法得出，下一时刻的速度估计量表示为，

3、所述判断速度量测值与速度估计量的差值是否满足条件具体包括：

设在k时刻得到的速度量测值为v(k)，当v(k)满足：

(1)、时，v(k)被接受；

(2)、时，v(k)是野值，被剔除，使用值代替v(k)；

δ值根据速度的误差分布特性和置信区间进行选取。

为了解决传输过程产生的速度错误值的剔除问题，本发明提出一种具有有限信任度的最小二乘外推方法进行速度信息的野值剔除。本发明的使用背景是在卡尔曼滤波系统中。

本发明的有益效果是：通过本发明提出的方法，实现了速度量测数据的预处理，减小由野值引起的误差和滤波发散。有利于接下来的滤波处理。

附图说明

图1是本发明的流程图。

图2是匀速运动速度野值剔除图。

图3是匀加速运动速度野值剔除图。

图4是不同门限下速度野值剔除有效率表。

具体实施方式

下面举例对本发明做更详细的描述。

结合图1，首先假设信任度为N。然后按如下步骤执行：

步骤一、获得目标当前时刻之前的4个时刻的速度信息；

步骤二、使用最小二乘算法外推出下一时刻的速度估计量；

步骤三、判断速度量测值与速度估计量的差值是否满足条件，若满足则速度量测值被接受。否则利用速度估计量代替速度量测值；

步骤四、当连续接收预测值的次数超过信任度N，重新建立滤波。

假设目标做匀速运动(v＝2m/s)或匀加速运动(v₀＝2m/s,a＝0.02m/s²)，速度观测量具有均值为0，标准差σ_v＝0.1m/s的高斯白噪声，由此获得目标当前时刻之前的4个时刻的速度信息。只考虑由传输错误引起的粗差较大的野值，在仿真中，设粗差范围为[1m/s,4m/s]。由此得到步骤一中的四个时刻的速度信息v(k-1)、v(k-2)、v(k-3)和v(k-4)。通过速度历史信息使用最小二乘算法进行外推可得出下一时刻的速度估计量。

δ值根据速度的误差分布特性和置信区间进行选取，选择置信度为99.994％，此时门限的取值约为δ＝0.5m/s，设置信任度N＝4。得到匀速运动速度野值剔除图如图1，匀加速运动速度野值剔除图如图2。