自适应滤波和联邦卡尔曼滤波课件.ppt

《自适应滤波和联邦卡尔曼滤波课件.ppt》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。

1、测绘学院五系自适应滤波和联邦卡尔曼滤波组合导航2021/8/171本次课主要内容主要内容：卡尔曼滤波自适应卡尔曼滤波联邦卡尔曼滤波重点和难点：自适应卡尔曼滤波2021/8/172卡尔曼滤波是一种递推线性最小方差估计。一、卡尔曼滤波设离散化后的系统状态方程和量测方程分别为：2021/8/1734选取15阶状态变量平台误差角速度误差位置误差陀螺随机常值漂移加速度计随机常值偏置2021/8/174一、卡尔曼滤波5系统状态方程状态转移矩阵噪声转移矩阵2021/8/175W系统噪声向量一、卡尔曼滤波6系统量测方程观测量由GNSS和IN

2、S获得的位置速度误差2021/8/176一、卡尔曼滤波系统量测方程一、卡尔曼滤波2021/8/177间接法滤波示意图输出校正用导航参数误差的估值去校正系统输出的导航参数，得到综合导航系统的导航参数估值即：间接法卡尔曼滤波器：将惯性系统和其他的导航系统各自计算的导航参数进行比较，其差值就包含了惯导某些导航参数误差，即：一、卡尔曼滤波2021/8/178离散卡尔曼滤波方程或状态一步预测方程状态估计计算方程滤波增益方程一步预测均方误差方程估计均方误差方程一、卡尔曼滤波8/17/20219滤波计算回路增益计算回路一、卡尔曼滤波202

3、1/8/1710（1）状态一步预测方程Xk-1的卡尔曼滤波估值利用计算得到的一步预测的均值为零一、卡尔曼滤波8/17/202111（2）状态估计方程计算估值Xk的方程。它是在一步预测Xk/k-1的基础上，根据量测值Zk计算出来的上式就是通过计算新息，并左乘一个系数矩阵把估计出来，加到中，从而得到估值，称为滤波增益矩阵一、卡尔曼滤波2021/8/1712（3）估计均方误差方程Kk选取的标准就是卡尔曼滤波的估计准则，也就是使得均方误差阵最小，为求Kk,先推导估计均方误差预测误差与量测噪声互不相关，故和与量测噪声互不相关。一、卡尔

4、曼滤波8/17/202113（4）滤波增益方程Kk选取的原则是使得均方误差阵最小；采用微分求极值的方法，即：将改为，得到的估计均方误差标以，其与的差值为，求出使为非负定的值就是使为最小的。一、卡尔曼滤波2021/8/1714是用来估计的系数矩阵。设状态矢量和量测矢量都是一维的，且H=1，这说明增益系数是预测均方误差在它和量测噪声方差之和中所占的比例。一、卡尔曼滤波增益矩阵的直观意义2021/8/1715（5）一步预测均方误差方程从下式可以看出，求Kk必须先求出Pk/k-1式中，为的估计误差，可以看出一步预测均方误差阵Pk/k

5、-1是从估计均方误差阵Pk-1转移过来的，并且再加上系统噪声方差的影响。的均方误差阵，即：一、卡尔曼滤波2021/8/1716二、自适应卡尔曼滤波在卡尔曼滤波计算中，可能出现发散的现象。当量测值数目不断增加时，按滤波方程计算的估计均方误差阵趋于零或趋于某一稳态值，但估计值和实际状态的偏差却越来越大，使滤波器逐渐失去估计作用。这种现象称为滤波器的发散。2021/8/1717设系统和量测为：状态和量测都是标量，和为互不相关的零均值白噪声序列，并有：设，试求解状态估计值，估计误差方差以及真实误差。在设计滤波器时误认为系统没有噪声，

6、即系统模型为：二、自适应卡尔曼滤波滤波发散例子2021/8/1718二、自适应卡尔曼滤波计算过程中的舍入误差引起。系统的数学模型或噪声模型的统计特性不准确，没有能够真实的反映系统的真实过程。滤波发散原因2021/8/1719二、自适应卡尔曼滤波Sage-Husa自适应滤波强跟踪Kalman滤波改进的自适应滤波渐消记忆自适应滤波平方根滤波几种主要的自适应滤波方法2021/8/1720二、自适应卡尔曼滤波Sage-Husa自适应滤波利用观测数据进行递推滤波的同时，通过时变噪声统计估值器，实时估计和修正系统噪声和观测噪声的统计特性

7、，从而达到降低模型误差、抑制滤波发散、提高滤波精度的目的。2021/8/1721二、自适应卡尔曼滤波1、利用标准的卡尔曼滤波方程计算出各个状态的估计值Sage-Husa自适应滤波2021/8/1722二、自适应卡尔曼滤波2、计算系统噪声和量测噪声的均值和方差矩阵Sage-Husa自适应滤波2021/8/1723二、自适应卡尔曼滤波Sage-Husa自适应滤波实时解算系统噪声统计特性，计算精度较高；增加了计算量，实时性难以保证；计算噪声方差易失去正定性，稳定性和收敛性不能完全保证。2021/8/1724二、自适应卡尔曼滤波强跟

8、踪Kalman滤波通过牺牲一定的精度换取滤波稳定性将状态估计一步预测均方误差阵乘以加权系数2021/8/1725二、自适应卡尔曼滤波强跟踪Kalman滤波状态发生突变跟踪状态变化2021/8/1726二、自适应卡尔曼滤波强跟踪Kalman滤波结构简单、跟踪能力强、可靠性高；破坏了滤波器的最