文档介绍：第六章自适应卡尔曼滤波§ 卡尔曼滤波基本模型§ 自适应卡尔曼滤波§ 卡尔曼滤波在测量和变形分析中的应用§ § 卡尔曼滤波基本模型卡尔曼滤波基本模型 概述卡尔曼滤波技术是 20 世纪 60 年代初由卡尔曼等人提出的一种递推式滤波算法,是一种对动态系统进行实时数据处理的有效方法。测量界开展了多方面的卡尔曼滤波应用研究工作,尤其是在变形监测中的应用较为广泛。例如,用于滑坡监测的数据处理;形变测量数据的动态处理;危岩体变形趋势预报; GPS 变形监测网的动态数据处理等。 数学模型数学模型动态系统的卡尔曼滤波数学模型包括状态方程和观测方程,对于线性系统,其离散形式为: 其中, 为系统在时刻的维状态向量, 为系统从时刻到时刻的维状态转移矩阵, 为时刻的动态噪声, 为时刻的动态噪声矩阵, 为系统在时刻的维观测向量, 为系统在时刻的维观测矩阵, 为系统在时刻维观测噪声/ 1 1 1 1 k k k k k k X F X G W ? ? ??? ? k k k k L H X V ? ? kX kt1n?/ 1 k kF ? 1kt ?kt n n ? 1kW ?1kt ? 1r? 1kG ?1kt ? n r ? kL kt1m? kH kt m n ? kV kt1m?( 6-1 ) ( 6-2 ) 式( 6-1 )和( 6-2 )是卡尔曼滤波的函数模型。对于卡尔曼滤波的统计模型,一般是假设动态系统具有平稳随机过程的统计特性,假设动态噪声和观测噪声是互补相关的高斯白噪声序列,即 kW kV ( ) 0 k E W ?, ( ) 0 k E V ?根据最小二乘原则,可推得卡尔曼滤波递推公式为: (1)状态向量一部预测值为( 6-3 ) / 1 / 1 1 ?? k k k k k X F X ? ???(2)状态向量一部预测值方差矩阵为( 6-4 ) / 1 / 1 1 / 1 1 1 1 T T k k k k k k k k k k P F P F G Q G ? ??????? ?其中, 为动态噪声方差矩阵。 1kQ ?( 6-5 ) (4)状态向量估计值方差矩阵为( 6-6 ) 其中, 为滤波增益矩阵,具体形式如下(3)状态向量估计值为/ 1 / 1 ???( ) k k k k k k k k X X J L HX ? ?? ??/ 1 ( ) k k k k k P I J H P ?? ? kJ 1 / 1 / 1 ( ) T T k k k k k k k k k J P H H P H R ?? ?? ?( 6-7 ) kR为观测噪声方差矩阵在根据上述递推公式进行卡尔曼滤波计算时需要确定动态系统的初始状态向量和方差矩阵,并假设初始状态向量具有如下统计特性 0?X 0?P 0 0 0 ?( ) X E X x ?? ? 0 0 ?( ) P Var X ?且与动态噪声和观测噪声不相关。 0?X kW kV对于常线性系统,则有,即它们都是常数矩阵;如果动态噪声和观测噪声都是平稳随机序列,则、都是常数矩阵。在这种情况下,常增益的卡尔曼滤波是渐进稳定的。/ 1, k k F F ?? k H H ? kQ kR§ § 自适应卡尔曼滤波自适应卡尔曼滤波自适应卡尔曼滤波的目的是,在利用观测数据进行滤波的同时,实时地对未知的或不确定知道的系统模型参数和噪声的统计特性进行适当的估计和修正, 以减弱模型误差的影响,使滤波结果更接近于实际。因此,自适应卡尔曼滤波主要是为了抑制滤波发散而提出地方法。自适应卡尔曼滤波的方法很多,包括 Sage 算法、相关算法、极大似然法以及协方差匹配法。这里介绍一种自适应卡尔曼的方差补偿法。其原理是在滤波过程中利用已有信息对动态噪声方差矩阵进行实时估计,以补偿滤波中对动态噪声方差或协方差估计的不足。 kQ 假设动态噪声和观测噪声为正态序列, 为正态向量。定义 L步预测剩余为 kW kV 0?X /? k l k l k l k V L L