观测器

固定增益跟踪滤波器

发布时间:2022/6/3 18:32:30   

固定增益跟踪滤波器也称固定系数滤波器,常见的有

滤波器及其变形。

跟踪器分别是一维二阶和三阶滤波器,它们等效于一维卡尔曼滤波的特例,其基本结构与卡尔曼滤波器相似。

滤波器对目标的位置、速率(多普勒)和加速度等信息进行平滑和预测,是一种具有多项预测和校正的线性递归滤波器。根据测量数据,

滤波器能够预测目标的位置、速率以及恒定加速度等信息,已广泛应用于导航和火控装置。

因为本期大多为公式推导过程,故先给出结果,最后有相关仿真可以做参考。

滤波器为跟踪滤波器,故其主要实现的功能即是通过目标现有状态的观测值(位置、速度、加速度等),预测目标下一时间的状态。

而由目标现有观测值得到目标的预测值需要通过状态转移矩阵

来完成。而预测过程中需要引入平滑处理来减小误差,同时还需要消除噪声的干扰,故还需要引入增益矩阵

,由状态转移矩阵

和增益矩阵

即可预测目标在下一时刻的状态。

表示采用

时刻以前的所有数据(包括

时刻)对第

时刻数据的估计值,

表示第

时刻的观测值,

表示第

时刻的误差。

固定增益滤波方程为

式中,

为状态转换矩阵,

矩阵在不同滤波器中会不同。借助状态转换矩阵预测下一个状态,

则可得

上式右边中括号内为残差(误差),即测量输入与预测输出之差。该式表示

的估计是预测值

和残差

加权之和,

代表预测状态。

这类预测器中,

以行向量给出

增益矩阵

如下

其中,上标的正体“T”表示转置,式中的斜体“

”表示采样周期。

跟踪滤波器的一个主要目标是降低测量过程中噪声的影响。为此,首先要计算噪声协方差矩阵,具体形式如下:

表示数学期望。假设噪声是均值为零、方差为

的随机过程,并且假设噪声之间不相关。即

则固定增益滤波方程可写为:

式中

,得:

将该式右边展开,即

稳态下,可合并为:

这里

为稳态噪声协方差矩阵,稳态时

确定固定增益滤波器性能的标准有很多,最常用的一种是计算方差的缩减率(VarianceReductionRatio,VRR),即当输入只有噪声时,输出噪声的方差(功率)与输入噪声的方差(功率)之比。在稳定状态情况下,它表示滤波器对噪声的抑制程度。

为了衡量跟踪滤波器的稳定性,对上式进行

变换,则

系统传递函数为:

式中

为特征矩阵。只有当特征矩阵为非奇异矩阵时,系统传递函数才存在。此外,当且仅当特征方程的根在平面的单位圆内时,系统才是稳定的,即

滤波器的稳定状态误差可用下图来确定,

误差的转换函数如下:

由阿贝尔(Abel)定理,稳态状态的误差为

滤波器

滤波器是在第

个观察时刻,对位置

及其速率

进行平滑和对第

时刻的位置进行预测。该滤波器的结构如下图所示。

滤波器能够没有任何稳态误差的跟踪输入距离斜坡(恒定速度)。然而,当输入端存在恒定加速度时,稳态误差将会累加起来。

在预测位置处,通过对测量值与预测值之差加权,并加在预测位置上进行平滑处理,以减小误差,如下式所示(下标“

”和“

”分别表示预测和平滑)。

是位置输入采样点,预测位置计算公式如下:

初始条件为

一维二阶线性时不变系统的协方差矩阵可表示如下:

这里,

一般为

通过观察,

滤波器具有下列形式:

增益矢量:

观测矢量:

状态转移矩阵:

最后,得出稳态噪声协方差矩阵为

则位置和速率的VRR计算公式如下

滤波器的稳定性取决于系统传递函数,由

,可得

的根为

为了满足稳定性,有

是实数时,

是复数时,可得出

得到系统传递函数为

上面对

滤波器的分析并未具体涉及增益系数(

)的选取。在考虑如何选择系数前,应考虑使用该滤波器的主要目标,

滤波器要实现以下两个目标:

跟踪器必须尽可能地降低测量噪声

能够跟踪机动目标,跟踪错误率降到最低。

减少观测噪声一般取决于VRR率。但是,滤波器的机动性能很大程度上决定了参数

的选择。一种特殊的

滤波器由Benedict和Bordner提出,因此也称为Benedict-Bordner滤波器。

该滤波器最主要的优点是降低瞬时误差。它用位置和速率的VRR率来测量其性能。它计算输入和输出的平方误差总和,并当参数

的选择满足下式时误差最小,

在这种情况下,位置和速率的VRR分别为

为了提高

滤波器的性能,提出了一种自动调节滤波器的参数

的方法,使得滤波值协方差最小,从而得到

的最优估计。

总之,要想提高

滤波器的性能,首先要考虑滤波器的结构设计问题,其次要考虑滤波器的参数设计问题。前者解决

滤波器跟踪机动目标的问题,而后者解决跟踪精度的问题。

滤波器

滤波器能够较好地平滑第

时刻的位置

、速率

、加速度

等信息,也能够预测第

时刻的位置和速率,其结构框图如下图所示。

滤波器将跟随一个加速度恒定、无稳态误差的输入。为了降低输出误差,在估计平滑位置、速度和加速度时,采用了测量值与预测值之差的加权差。具体如下:

初始条件为

滤波器的状态转移矩阵

噪声协方差矩阵(对称)可由式

计算出。注意到:

增益矢量:

观测矢量:

将上式代入式

,计算位置、速度、加速度的VRR为

与任何离散时间系统类似,当且仅当所有极点都落在单位圆内,滤波器才稳定。

以下求解

滤波的特征方程

整理可得出以下特征函数

滤波器转化成Benediet-bordner滤波器。注意当

时,上式简化为

。临界衰减滤波器的增益系数如下

为平滑系数,当

趋近于

时,产生深度平滑,而当

时没有平滑。

假设一目标它的初始时刻的距离为

,初始速度为

,加速度为

,因此在理想的情况下(不考虑噪声或干扰),目标的运动轨迹为

若采样间隔为

,采样点数为

,平滑系数分别为

,则利用式

可计算出与之相对应的临界衰减滤波器的增益系数。当

时,增益系数

;当

时,增益系数

。观测噪声为零均值、方差为

。下图(左)为这两种增益时对观测点迹的

滤波结果,下图(右)为这两种不同增益情况下点迹的估计误差。可见,利用

滤波器可以减小观测点迹的误差。

滤波器的仿真代码如下图所示。

预览时标签不可点收录于合集#个上一篇下一篇
转载请注明:http://www.aideyishus.com/lkzp/455.html
------分隔线----------------------------

热点文章

  • 没有热点文章

推荐文章

  • 没有推荐文章