第06章-卡尔曼滤波

第六章

Kalman滤波与状态估计

6.1引言滤波的定义滤波：从被污染的观测信号中过滤噪声，消除或减少噪声影响，求未知真实信号或系统状态的最优估计。滤波问题本质上是统计最优估计问题，常用的最优估计准则是线性最小方差估计。

经典滤波方法：

Wiener滤波方法和Kalman滤波方法

Wiener滤波：20世纪40年代，频域法

缺点：（1）滤波器非递推，计算量和存储量大（2）针对单变量平稳随机信号（3）仅可解决定常系统滤波器设计问题

Kalman滤波：20世纪60年代，状态空间方法

优点：

（1）算法递推，计算量和存储量小（2）可处理多变量非平稳随机过程滤波问题

（3）可处理时变系统滤波问题运用：

Kalman滤波方法工程实践中获得广泛的应用，例如，应用于制导、控制、GPS定位、故障诊断、多传感器信息融合等领域，对国防建设起着至关重要的作用。

状态空间方法

引入了状态变量和状态空间概念。状态是比信号更广泛、更灵活的概念

非常适合处理多变量系统

非常适合处理信号估计问题

信号可视为状态或状态的分量，系统状态变量是能体现系统特征、特点和状况的变量

状态空间方法关键技术：状态空间模型

描写状态变化规律的模型，它描写了相邻时刻的状态转移变化规律。

观测方程

描写对状态进行观测的信息，通常含有观测噪声，且通常只能对部分状态变量进行观测。

基于射影理论的状态估计方法

Kalman滤波问题在几何上化为状态变量在由观测信号生成的子Hilbert空间上的射影。

经典Kalman滤波理论重要进展：

——白噪声估计理论的创立运用：美国学者J.M.Mendel以石油地震勘探数据处理为应用背景，提出了动态系统的输入白噪声估值器。埋在地表下的炸药爆炸后产生的地震波在地层的反射系数序列可用Bernoulli-Gaussian白噪声来描写，它含有是否有油田及油田几何形状的重要信息。理论意义：统一解决白噪声估计问题，即解决输入白噪声和观测白噪声的估计问题，可以从理论上解决状态和信号估计问题，为最优滤波提供新方法论和新途径，具有重大理论意义。

启发性例1：

船舶GPS导航定位问题

(具体过程见书95页)

系统的状态空间模型为

(6.1.8)(6.1.9)且称式(6.1.8)为状态方程、(6.1.9)为观测方程。于是船舶GPS导航定位Kalman滤波问题是：基于GPS观测数据求船舶在时刻处的位置的最优估计。为了提高GPS定位精度，还可利用GPS给出的船舶运动速度观测信号

即，其中为观测噪声，假设它是零均值，方差为独立于和的白噪声。此时有观测方程

(6.1.11)其中定义

(6.1.12)于是GPS导航定位Kalman滤波问题是：对系统式(6.1.8)和(6.1.11)求船舶位置的最优估计。6.2射影理论Kalman滤波器是线性最小方差估值器，也叫最优滤波器，在几何上Kalman滤波估值可看成是状态变量在由观测生成的线性空间上的射影。因此射影理论是Kalman滤波推导的基本工具。

定义：由随机变量的线性函数估计随机变量，记估值为若估值极小化性能指标则称为随机变量的线性最小方差估计。推导线性最小方差估值定义：

称为方差阵

称为协方差阵

线性最小方差估值性质

性质1：无偏性，即

证：

性质2：

与不相关

证：定义：由

引入分块矩阵可得

张成的线性流形定义为

新息序列新息序列几何意义

可以证明，新息序列是零均值白噪声序列。这表明新息序列是正交（不相交）序列，通过引入新息序列实现了非正交（相关）随机序列的正交化。

递推射影公式

6.3Kalman滤波器和预报器

分析：由递推射影公式(6.2.19)有递推关系称为Kalman滤波器增益。对(6.3.1)两边取射影有从而有由(6.3.4)、假设6.3.1和假设6.3.2有由假设6.3.1、假设6.3.2和(6.3.4)有(6.3.3)成为

对(6.3.2)取射影有故有于是有

这引出新息表达式记滤波和预报估值误差及方差阵为则由(6.3.2)和(6.3.5)有新息表达式由得为求Kalman滤波器增益，为此，求

用简化，得：定理1

系统(6.3.1)和(6.3.2)在假设6.3.1、假设6.3.2下，递推Kalman滤波器为

在定理1条件下，Kalman滤波器有另一种递推形式

初值取(6.3.7)是为了保证估值的无偏性。Kalman滤波器计算程序框图如图1所示。

图1Kalman滤波计算法程序框图

Kalman滤波器增益阵是时变的。实现最优Kalman滤波器要求在每时刻计算增益阵，带来较大计算负担。简化Kalman滤波器增益计算的途径是考察Kalman滤波器增益阵是否趋于常阵？

6.7

稳态Kalman滤波最优时变Kalman滤波器为假如增益存在极限则稳态Kalman滤波器为考虑一维系统

什么条件下，滤波增益存在极限？这是稳态

Kalman滤波器存在的问题。由6.6.3节定理可得Kalman滤波器