Ch6线性离散系统卡尔曼滤波

《Ch6线性离散系统卡尔曼滤波》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。

1、最优估计1第6章线性离散系统卡尔曼滤波线性离散系统卡尔曼滤波器的推导带有控制项和测量系统偏差时的卡尔曼滤波器系统干扰和测量噪声相关时的卡尔曼滤波器有色噪声下的卡尔曼滤波器卡尔曼滤波器稳定性和鲁棒性线性离散系统的最优预测与平滑26.1引言1960年卡尔曼（Kalman）将状态空间分析方法引入滤波理论，得到时域上的递推滤波算法，即卡尔曼滤波。(1)要求随机过程是平稳的，要求太强；(2)以单入单出系统推导出的，难以推广到高维的情况；(3)维纳-霍夫方程很难求解，在工程上难以实现；(4)是批处理方法，不能满足在线快速处理大量数据的需要。维纳滤波的不足：与维纳滤波相比，卡尔曼滤波不仅适用于非

2、平稳随机过程，而且可以递推实现。系统和量测的数学模型噪声及初值统计特性状态和估计方差初值量测数据系统状态的最优估值KalmanFilter:3噪声和初值的统计特性：离散模型：已知：要求：零均值，方差阵为对角阵过程噪声和观测噪声不相关初值和过程噪声、观测噪声均不相关离散卡尔曼滤波器公式推导4预测/时间更新(利用系统方程对状态及观测做一步预测)：校正/测量更新(利用新观测对预测状态进行校正)：KF公式2：观测预测KF公式3：状态估计待定校正增益阵如何求？KF公式1：状态预测6.2直观推导法推导基本步骤：预测，校正。5估计误差：估计误差方差：6（2）将Jk对Kk的偏导数为零，即KF公式5

3、：增益矩阵估计误差方差矩阵，与KF公式4等价KF公式4：估计误差方差矩阵为了求得Kk，（1）选择代价函数：7KF公式6：预测误差方差矩阵预测误差：预测误差方差：8卡尔曼滤波的实质递推估计的过程；预测+校正的过程。时间更新zKK=k+1测量更新初始状态和方差9状态预测方差预测增益矩阵状态估值方差估值预测/时间更新：校正/观测更新：新息序列离散卡尔曼滤波器推算方程10离散卡尔曼滤波公式公式汇总11卡尔曼滤波器结构图延时一步+-++当前估计值上一步估计值一步预测121.滤波递推实现，必须给定初值（状态和方差）；几点说明：2.当前状态最优估值：4.KF是反馈校正过程，其校正项：，比例因子：

4、5.增益：6.预测方差：初始估值可由经验给定，方差需经测量，由统计方法给出；若滤波是稳定的，滤波将不依赖于初值。3.估计方差的作用：计算增益，但给出了误差分析。13最小二乘估计和卡尔曼滤波估计都是无偏估计，都能在得到系统最优状态估计值的同时，还得到估计误差的方差；均适用于状态为向量的情况。维纳滤波和卡尔曼滤波都是最小方差估计。维纳滤波要求系统的输入是平稳过程，最小二乘和卡尔曼滤波无此要求。最小二乘估计法可行的条件是只需要系统的测量方程和测量误差方差的信息，有递推算法，最优解是状态值；维纳滤波需要知道系统的输入和噪声的功率谱密度，以及输入和噪声的互谱密度，属于批处理方法，最优解是滤波

5、器的传递函数或是冲激响应，对状态为向量的情况不容易实现；卡尔曼滤波可行的条件是不仅需要系统的测量方程，还需要系统的状态方程以及系统干扰和测量误差的均值和方差信息，递推方法，可以实时实现，最优解是系统的状态。卡尔曼滤波&最小二乘&维纳滤波14卡尔曼滤波的直观解释卡尔曼滤波的基本思想与舰船组合导航人员作业中对船位推算的逻辑思维方法是吻合的。基本思想都可以归结为“预测+修正”。卡尔曼滤波过程是：每隔一个滤波周期，通过量测传感器得到量测船位C，同时经过状态转移得到预测船位B，在量测船位和预测船位之间根据增益Kk进行折衷，从而获得最佳估计船位D，依此过程不断循环下去。15例6.2已知离散型线

6、性系统的状态方程和观测方程如下1617应用实例1——舰船导航状态向量：状态方程：观测方程：1.系统模型182.初始条件193.仿真仿真结果(1)20仿真结果(2)21仿真结果(3)226.3带有控制项和测量偏差的卡尔曼滤波器滤波方程：236.4系统噪声和测量噪声相关时的卡尔曼滤波系统模型：相关噪声：其他条件与6.2中相同。条件改变，不符合Kalman基本方程，前面的结果不能直接套用，需要对方程作形式上的修改，化为符合条件的形式，再利用之前结果。方法：引入类似于Lagrange乘子的待定常数矩阵，适当选取这个矩阵，变非约束方称为约束方程，将约束条件纳入方程，变成符合基本假设条件的形式

7、。已知在动态方程右端增加一个恒为零的项：24待定矩阵注意到模型中只有系统方程不同，所以与前相比，只有预测方程不同。25一步预测：一步预测误差：预测误差方差：26噪声wk和vk相关时的卡尔曼滤波递推方程：276.5有色噪声下的卡尔曼滤波器若有色噪声可以用白噪声激发的线性系统得到，可通过增广状态向量的方法，将噪声作为状态向量的一部分进行估计。系统模型：w1和v为有色噪声，分别对应一个成型滤波器：白噪声只是一种理想噪声，实际的噪声总有一定的相关性，只有在相关性较弱时，才可以