交互设计网站案例,网络营销推广方案公司,台州网站建设解决方案,wordpress 去掉 顶部一.状态空间方程 系统的状态空间方程描述了系统的动态行为和状态演化过程。它由两个方程组成#xff1a;状态方程和观测方程。系统的状态空间表达式简写为#xff1a; 变量描述如下#xff1a;
x(t) 是系统的状态向量#xff0c;表示系统在时间 #x1d461;的状态。状态方程和观测方程。系统的状态空间表达式简写为 变量描述如下
x(t) 是系统的状态向量表示系统在时间 的状态。() 是系统的输入向量表示系统在时间 的输入。() 是系统的输出向量表示系统在时间 的观测输出。A 是状态矩阵描述系统状态的演化规律。B 是输入矩阵描述输入对系统状态的影响。C 是观测矩阵描述状态对观测输出的映射关系。D 是直接传递矩阵描述输入对观测输出的直接影响。
框图如下 观测器也称为状态观测器是一种用于估计系统状态的非递归算法。观测器通常基于系统的输出观测和已知的系统模型通过最小化观测误差来估计系统的状态。观测器可以是线性的或非线性的它们的设计依赖于系统的特性和观测数据的可用性下图为一个开环的观测器 事实上若没有反馈的话开环观测器的误差会不断增大最后导致观测器不再贴合观测的系统我们可以引入反馈环节用于修正误差。卡尔曼滤波器可以看作是一种特殊的观测器它利用系统的动态模型和观测数据来估计状态。卡尔曼滤波器中的状态估计和协方差更新步骤与观测器中的状态估计和观测误差最小化步骤类似。在卡尔曼观测器中反馈增益K就为卡尔曼增益 其中为引入反馈增益修正后的后验估计为先验估计。在没有反馈机制的情况下观测器的输出不会受到状态估计误差的修正。如果观测噪声较大或者观测模型不准确观测器的输出可能会与真实状态之间存在较大的误差。随着时间的推移这些误差可能会逐渐累积并导致状态估计的误差增大。因此在引入反馈增益K的基础上将上述框图改为离散化得到 因此要确定的就是卡尔曼增益K。
二.理论推导部分 由上图可知卡尔曼滤波器实际上就是反馈增益K为卡尔曼增益的观测器核心在于找到一个K使得误差的协方差最小记后验估计误差如下 当越小时也就是误差协方差越小时观测器越逼近于真实系统故实际需要求的卡尔曼增益就是使得最小时的即 考虑过程噪声以及观测噪声得到系统的状态空间方程 又由于 则化简得到 两边同时加上得到 记后验误差为 记先验误差为 其中为单位矩阵将本式带入到误差表达式中得到 为简化计算将后验误差协方差矩阵记作,先验误差协方差矩阵记作,观测噪声的协方差矩阵为得到 最终要求得的最小化的目标值实际上就是协方差矩阵对角线的元素和 化简得到 考虑到则上述方程对卡尔曼增益求导解出使误差协方差最小时的卡尔曼增益 将所求的卡尔曼增益代入到后验误差协方差矩阵的表达式中得出 故在上述所有公式中唯一还没有确定的只剩下先验误差协方差矩阵确定过程如下 三.总结 至此卡尔曼滤波的五个公式均推导完毕总结一下就是
1状态观测器 2预测部分
①先验估计 ②先验协方差误差 3校正部分
①卡尔曼增益: ②更新协方差误差 ③后验估计
