下载文档原格式
卡尔曼滤波五个公式推导过程1.系统的状态方程假设我们有一个线性动态系统，可以用如下的状态方程来描述：x(k)=Ax(k-1)+Bu(k-1)+w(k-1)其中，x(k)表示系统在时刻k的状态向量，A是系统的状态转移矩阵，B是输入变量矩阵，u(k-1)是输入变量向量，w(k-1)是过程噪声。
2.系统的测量方程假设我们的系统是通过一些传感器进行测量的，测量结果表示为：z(k)=Hx(k)+v(k)其中，z(k)是系统的测量向量，H是观测矩阵，v(k)是测量噪声。
3.状态估计的预测根据系统的状态方程，我们可以预测系统在下一个时刻的状态。
预测的结果表示为：x^(k)=Ax(k-1)+Bu(k-1)其中，x^(k)表示状态的预测向量。
4.测量更新在得到测量结果后，我们可以根据测量更新系统的状态估计。
计算出的状态估计称为卡尔曼增益。
卡尔曼增益的计算公式如下：K(k)=P^(k)H^T(HP^(k)H^T+R)^-1其中，P^(k)是状态协方差的预测值，R是测量噪声的协方差。
5.状态估计的更新通过卡尔曼增益，我们可以计算出最终的状态估计。
状态估计的更新公式如下：x(k)=x^(k)+K(k)(z(k)-Hx^(k))P(k)=(I-K(k)H)P^(k)其中，I是单位矩阵，P(k)是状态协方差的最优估计。
以上就是卡尔曼滤波的五个公式的推导过程。
通过这五个公式，我们可以根据系统的状态方程和测量方程，利用预测和更新步骤，得到最优的状态估计结果。
卡尔曼滤波在各个领域都有广泛的应用，如目标跟踪、定位导航等。
Kalman滤波原理及算法kalman滤波器一(什么是卡尔曼滤波器卡尔曼全名Rudolf Emil Kalman，匈牙利数学家，1930年出生于匈牙利首都布达佩斯, 我们现在要学习的卡尔曼滤波器，正是源于他的博士论文和1960年发表的论文《A New Approach to Linear Filtering and Prediction Problems》(线性滤波与预测问题的新方法)。
二.卡尔曼滤波器算法的介绍以下是卡尔曼滤波器核心的5个式子。
X(k|k-1)=A X(k-1|k-1)+B U(k) (1)P(k|k-1)=A P(k-1|k-1) A’+Q (2)X(k|k)= X(k|k-1)+Kg(k) (Z(k)-H X(k|k-1)) (3)Kg(k)= P(k|k-1) H’ / (H P(k|k-1) H’ + R) (4)P(k|k)=(I-Kg(k) H)P(k|k-1) (5)下面我们详细介绍卡尔曼滤波的过程。
首先，我们要引入一个离散控制过程的系统。
该系统可用一个线性随机微分方程来描述:X(k)=A X(k-1)+B U(k)+W(k)再加上系统的测量值:Z(k)=H X(k)+V(k)上两式子中，X(k)是k时刻的系统状态，U(k)是k时刻对系统的控制量。
A和B是系统参数，对于多模型系统，他们为矩阵。
Z(k)是k时刻的测量值，H是测量系统的参数，对于多测量系统，H为矩阵。
W(k)和V(k)分别表示过程和测量的噪声。
他们被假设成高斯白噪声(White Gaussian Noise)，他们的covariance分别是Q，R(这里我们假设他们不随系统状态变化而变化)。
对于满足上面的条件(线性随机微分系统，过程和测量都是高斯白噪声)，卡尔曼滤波器是最优的信息处理器。
下面我们来用他们结合他们的covariances来估算系统的最优化输出。
首先我们要利用系统的过程模型，来预测下一状态的系统。
卡尔曼滤波总结假设条件：系统的状态由图1所给出的模型决定。
假定),1(k k+Φ，),1(k k+Γ，)0(P 和)(k Q 是已知的，并且是确定性的。
而观测模型由图2给出，其中)1(+kH 和)(k R 也是已知的，并且是确定性的。
它们可以写为,1,0),(),1()(),1()1(=+Γ++Φ=+k k w k k k x k k k x 状态方程)1()1()1()1(++++=+k v k x k H k z 量测方程)1(+k w激励)1(+k图1 一个离散-时间线性系统的状态方程和输出方程的矢量结构图观测转移矩阵 )1(+k xv (k+1)矢量求和激励)1(+k观测矢量 观测误差新状态矢量图2 观测模型的矢量结构图卡尔曼滤波算法：滤波估计由Kalman 所给出的最优线性滤波估计)1|1(ˆ++k k x是由下面的递归矩阵公式决定的，即,0)0|0(ˆ)]|(ˆ),1()1()1()[1()|(ˆ),1()1|1(≥=+Φ+-++++Φ=++k xk k xk k k H k z k K k k xk k k k x 初始条件这里)1(+kK 称为卡尔曼增益卡尔曼增益卡尔曼增益的表达式为,1,0,)]1()1()|1()1([)1()|1()1(1=+++++⨯++=+-k k R k H k k P k H k H k k P k K TT其中)|1(k kP +表示单步预测误差协方差矩阵。
单步预测误差协方差矩阵（单步性能）1,0)0()0|0(),1()(),1(),1()|(),1()|1(==+Γ+Γ++Φ+Φ=+k P P k k k Q k k k k k k P k k k k P TT，初始条件滤波误差的误差协方差矩阵（协方差递归形式）1,0),|1()]1()1([)1|1(=+++-=+k k k P k H k K I k k P ＋性能评价（系统状态的卡尔曼滤波估计的协方差矩阵）1,0],))1|1(ˆ)1(ˆ))(1|1(ˆ)1([()1|1(=++-+++-+=+k k k x k x k k xk x E k k P T＋11|11|----Γ+Φ=k k k k k k kW XXkkk k V XH Z +=式中：k X —— 是一个1⨯n 维矢量，称为k t 时刻的状态矢量。
卡尔曼滤波器原理详解卡尔曼滤波器是一种用于估计系统状态的滤波算法，其原理基于状态空间模型和观测模型，并结合最小均方误差准则。
它通过使用系统动态方程和观测值，对系统的状态进行估计和预测，实现对噪声和偏差的最优抑制，从而提高状态估计的精度和稳定性。
1.预测步骤：预测步骤是基于系统的动态方程，利用上一时刻的状态估计和控制输入，预测系统的状态。
预测步骤中，通过状态转移矩阵A将上一时刻的状态估计值x(k-1)预测到当前时刻的状态估计值的先验估计值x'(k)：x'(k)=A*x(k-1)+B*u(k-1)其中，x(k-1)为上一时刻的状态估计值，u(k-1)为控制输入。
预测步骤还要对状态估计值的协方差矩阵P(k-1)进行更新，通过状态转移矩阵A和系统的过程噪声协方差矩阵Q的关系：P'(k)=A*P(k-1)*A'+Q2.更新步骤：更新步骤是基于观测模型，利用当前时刻的观测值和预测的状态估计值，对状态进行校正和更新。
更新步骤中，首先计算观测残差z(k)：z(k)=y(k)-H*x'(k)其中，y(k)为当前时刻的观测值，H为观测模型矩阵。
然后基于观测模型矩阵H、预测的状态估计值x'(k)和状态估计值的协方差矩阵P'(k)，计算卡尔曼增益K(k)：K(k)=P'(k)*H'*(H*P'(k)*H'+R)^(-1)其中，R为观测噪声协方差矩阵。
最后，利用卡尔曼增益对状态估计值进行校正和更新：x(k)=x'(k)+K(k)*z(k)更新步骤还要对状态估计值的协方差矩阵P'(k)进行更新，通过卡尔曼增益K(k)和观测噪声协方差矩阵R的关系：P(k)=(I-K(k)*H)*P'(k)其中，I为单位矩阵。
卡尔曼滤波器的主要优点在于可以根据系统的动态方程和观测模型进行状态估计，对于动态系统和噪声的建模具有一定的灵活性。
卡尔曼滤波详解一维卡尔曼滤波实例解析（五个公式以及各个参数的意义）一、问题描述假设我们有一个一维系统，我们想要估计这个系统的状态x。
我们可以通过一维传感器获得关于这个系统的观测z，但是这个观测会存在误差。
二、基本原理三、基本公式1.状态预测：我们首先假设系统可以通过一个线性方程来描述：x(k)=Ax(k-1)+B(u(k))+w(k)，其中x(k)代表系统在时刻k的真实状态，A是系统的状态转移矩阵，B是外部输入的影响矩阵，u(k)是外部输入，w(k)是系统状态预测过程中的噪声。
2.状态协方差预测：卡尔曼滤波同时也需要估计状态的不确定性，即状态协方差。
协方差可以通过以下公式进行预测：P(k)=AP(k-1)A^T+Q(k-1)，其中P(k)代表状态协方差矩阵，Q(k-1)是协方差预测过程中的噪声。
3.观测预测：将状态的估计值带入观测模型中，可以预测观测值：z^(k)=Hx^(k)，其中z^(k)代表预测的观测值，x^(k)代表状态的估计值，H是观测模型矩阵。
4.观测残差：观测残差即观测值与预测观测值之间的差异：y(k)=z(k)-z^(k)，其中y(k)代表观测残差。
5.状态更新：基于观测残差，我们可以通过以下公式更新状态的估计值：x(k)=x^(k)+K(k)y(k)，其中K(k)代表卡尔曼增益。
卡尔曼增益可以通过以下公式计算：K(k)=P(k)H^T(HP(k)H^T+R)^-1，其中R为观测噪声的方差。
四、参数含义1.状态转移矩阵A：描述系统状态k与状态k-1之间的转移关系。
2.外部输入矩阵B：外部输入对系统状态的影响矩阵。
3.外部输入u(k)：外部输入，可以是控制信号或者测量噪声。
4.状态预测噪声w(k)：在状态预测过程中引入的噪声。
5.状态协方差矩阵P：表示状态估计的不确定性，协方差矩阵的对角线上的元素越大，状态的不确定性越大。
6.状态协方差预测噪声Q(k)：在状态协方差预测过程中引入的噪声。
卡尔曼滤波算法原理及应⽤卡尔曼滤波是⼀种⾼效率的递归滤波器，它能够从⼀系列的不完全及包含噪声的测量中，估计动态系统的状态。
卡尔曼滤波在技术领域有许多的应⽤，常见的有飞机及太空船的导引、导航及控制。
卡尔曼算法主要可以分为两个步骤进⾏：预测和更新。
基于最⼩均⽅误差为最佳估计准则，利⽤上⼀时刻的估计值和状态转移矩阵进⾏预测，⽤测量值对预测值进⾏修正，得到当前时刻的估计值。
卡尔曼算法公式预测：1. ˆs(n |n −1)=A ˆs (n −1|n −1)2. P (n )=A ξ(n −1)A T +Q 更新：3. G (n )=P (n )C T [CP (n )C T +R ]−14. ξ(n )=(I −G (n )C )P (n )5. ˆs(n |n )=ˆs (n |n −1)+G (n )[x (n )−C ˆs (n |n −1)]利⽤上⾯五个式⼦可以递推得到状态的估计值ˆs (n |n )。
⽂章的组织如下：1.基本模型及假设2.卡尔曼算法原理及推导3.卡尔曼滤波算法举例4.Matlab 程序1.基本模型与假设状态⽅程（描述物体运动状态）s (n )=As (n −1)+w (n )测量⽅程（利⽤探测器等器件获取物体状态参数）x (n )=Cs (n )+v (n )其中w (n )为过程噪声，v (n )为测量噪声。
假设：w (n )，v (n )，为独⽴零均值的⽩噪声过程，即E [w (n )w T (k )]=Q (n ),n =k 0,n ≠k E [v (n )v T (k )]=R (n ),n =k 0,n ≠kv (n )和s (n )、w (n )不相关，即E [v (n )s (n )]=0E [v (n )w (n )]=02.卡尔曼算法原理及推导基于最⼩均⽅误差准则，通过观测值x (n )求真实信号s (n )的线性⽆偏最优估计。
已知上⼀时刻的估计值ˆs(n −1|n −1)利⽤状态⽅程对s (n )进⾏预测，最佳预测为{{ˆs(n|n−1)=Aˆs(n−1|n−1)利⽤测量⽅程对x(n)进⾏预测，最佳预测为ˆx(n|n−1)=Cˆs(n|n−1)=CAˆs(n−1|n−1)噪声不参与预测。
本文将对卡尔曼滤波算法进行示例解析与公式推导，帮助读者更好地理解该算法的原理和应用。
文章将从以下几个方面展开：一、卡尔曼滤波算法的概念卡尔曼滤波算法是一种用于估计动态系统状态的线性无偏最优滤波算法。
它利用系统的动态模型和观测数据，通过迭代更新状态估计值，实现对系统状态的精确估计。
卡尔曼滤波算法最初是由美国工程师鲁道夫·卡尔曼在20世纪60年代提出，随后得到了广泛的应用和研究。
二、卡尔曼滤波算法的原理1. 状态空间模型在卡尔曼滤波算法中，系统的动态模型通常用状态空间模型表示。
状态空间模型由状态方程和观测方程组成，其中状态方程描述系统的演化规律，观测方程描述观测数据与状态之间的关系。
通过状态空间模型，可以对系统的状态进行预测，并与观测数据进行融合，从而估计系统的状态。
2. 卡尔曼滤波的预测与更新卡尔曼滤波算法以预测-更新的方式进行状态估计。
在预测阶段，利用系统的动态模型和之前时刻的状态估计值，对当前时刻的状态进行预测；在更新阶段，将预测值与观测数据进行融合，得到最优的状态估计值。
通过迭代更新，可以不断优化对系统状态的估计，实现对系统状态的精确跟踪。
三、卡尔曼滤波算法的示例解析以下通过一个简单的例子，对卡尔曼滤波算法进行具体的示例解析，帮助读者更好地理解该算法的应用过程。
假设有一个匀速直线运动的物体，其位置由x和y坐标表示，观测到的位置数据带有高斯噪声。
我们希望利用卡尔曼滤波算法对该物体的位置进行估计。
1. 状态空间模型的建立我们建立物体位置的状态空间模型。
假设物体在x和y方向上的位置分别由状态变量x和y表示，动态模型可以用如下状态方程描述：x(k+1) = x(k) + vx(k) * dty(k+1) = y(k) + vy(k) * dt其中，vx和vy分别为x和y方向的速度，dt表示时间间隔。
观测方程可以用如下形式表示：z(k) = H * x(k) + w(k)其中，z(k)为观测到的位置数据，H为观测矩阵，w(k)为观测噪声。
卡尔曼滤波详解卡尔曼滤波是一种常用的状态估计方法，它可以根据系统的动态模型和观测数据，对系统的状态进行估计。
卡尔曼滤波广泛应用于机器人导航、飞行控制、信号处理等领域。
本文将详细介绍卡尔曼滤波的原理、算法及应用。
一、卡尔曼滤波原理卡尔曼滤波的基本思想是利用系统的动态模型和观测数据，对系统的状态进行估计。
在卡尔曼滤波中，系统的状态被表示为一个向量，每个元素表示系统的某个特定状态量。
例如，一个机器人的状态向量可能包括机器人的位置、速度、方向等信息。
卡尔曼滤波的基本假设是系统的动态模型和观测数据都是线性的，而且存在噪声。
系统的动态模型可以表示为：x(t+1) = Ax(t) + Bu(t) + w(t)其中，x(t)表示系统在时刻t的状态向量，A是状态转移矩阵，B是控制矩阵，u(t)表示外部控制输入，w(t)表示系统的过程噪声。
观测数据可以表示为：z(t) = Hx(t) + v(t)其中，z(t)表示系统在时刻t的观测向量，H是观测矩阵，v(t)表示观测噪声。
卡尔曼滤波的目标是根据系统的动态模型和观测数据，估计系统的状态向量x(t)。
为了达到这个目标，卡尔曼滤波将状态估计分为两个阶段：预测和更新。
预测阶段：根据系统的动态模型，预测系统在下一个时刻的状态向量x(t+1)。
预测的过程可以表示为：x^(t+1|t) = Ax^(t|t) + Bu(t)其中，x^(t|t)表示在时刻t的状态向量的估计值，x^(t+1|t)表示在时刻t+1的状态向量的预测值。
卡尔曼滤波还需要对状态的不确定性进行估计，这个不确定性通常用协方差矩阵P(t)表示。
协方差矩阵P(t)表示状态向量估计值和真实值之间的差异程度。
预测阶段中，协方差矩阵也需要进行更新，更新的过程可以表示为：P(t+1|t) = AP(t|t)A' + Q其中，Q表示过程噪声的协方差矩阵。
更新阶段：根据观测数据，更新状态向量的估计值和协方差矩阵。
更新的过程可以表示为：K(t+1) = P(t+1|t)H'(HP(t+1|t)H' + R)^-1x^(t+1|t+1) = x^(t+1|t) + K(t+1)[z(t+1) - Hx^(t+1|t)]P(t+1|t+1) = (I - K(t+1)H)P(t+1|t)其中，K(t+1)表示卡尔曼增益，R表示观测噪声的协方差矩阵，I是单位矩阵。
卡尔曼滤波算法卡尔曼滤波算法卡尔曼滤波器是⼀个“最优化⾃回归数据处理算法”。
对于解决⼤部分的问题，它是最优，效率最⾼甚⾄是最有⽤的。
其⼴泛应⽤已经超过30年，包括机器⼈导航，控制，传感器数据融合甚⾄在军事⽅⾯的雷达系统以及导弹追踪等。
近年来更被应⽤于计算机图像处理，列⼊，⾯部识别，图像分割，图像边缘检测等⽅⾯。
卡尔曼滤波原理⾸先要引⼊⼀个离散控制过程的系统，该系统可⽤⼀个线性随机微分⽅程来秒速：X（k）=AX（k-1）+BU（k）+W（k）（1）再加上系统的测量值：Z（k）=HX（k）+V（k）（2）上两式⼦中，X（k）是k时刻的系统状态，U（k）是k时刻对系统的控制量。
A和B 是系统参数，对于多模型系统，它们为矩阵。
Z（k）是k时刻的测量值，H是测量系统的参数，对于多测量系统，H为矩阵。
W（k）和V(k)分别表⽰过程和测量的噪声。
它们被假设成⾼斯⽩噪声，其协⽅差分别是Q,R,这⾥假设它们不随系统状态变化⽽变化。
由于满⾜上⾯的条件（线性随机微分系统，过程和测量都是⾼斯⽩噪声），卡尔曼滤波器是最优的信息处理器。
下⾯来估算系统的最优化输出。
⾸先利⽤系统的过程模型预测下个状态的系统。
假设现在的系统状态是k，根据系统的模型，可以基于系统的上⼀状态⽽预测出现在状态：X（k|k-1）=AX（k-1|k-1）+BU（k）（3）式（3）中，X（k|k-1）是利⽤上⼀个状态预测的结果，X（k-1|k-1）是上⼀个状态最优的结果，U（k）为现在状态的控制量，如果没有控制量，它可以为0.到现在为⽌，系统结果已经更新了，可是对应于X(k|k-1)的协⽅差还没有更新。
⽤P 表⽰协⽅差：P（k|k-1）=AP（k|k-1）A’+Q（4）式⼦（4）中P（k|k-1）是X（k|k-1）对应的协⽅差，P（k-1|k-1）是X（k-1|k-1）对应的协⽅差，A’表⽰A的转置矩阵，Q时系统过程的协⽅差。
式（3），式（4）就是卡尔曼滤波器5个公式当中的前两个，也就是对系统的预测。
卡尔曼滤波器的五个公式
1.状态方程：描述系统状态随时间的变化。
通常为一个一阶差分方程，常见形式为x(k)=Ax(k-1)+Bu(k)，其中x为状态向量，u为控制向量，A为状态转移矩阵，B为控制矩阵。
2. 观测方程：描述系统状态的观测值随时间的变化。
通常为一个线性方程，常见形式为z(k)=Hx(k)+v(k)，其中z为观测向量，H 为观测矩阵，v为观测噪声。
3. 预测方程：预测下一时刻系统状态的值。
通常为状态方程的简化形式，只考虑状态转移矩阵和控制向量。
4. 卡尔曼增益方程：用于计算状态估计值和观测值之间的差距，从而校正预测值。
通常为K(k)=PH^T(HPH^T+R)^-1，其中P为状态协方差矩阵，R为观测噪声协方差矩阵。
5. 更新方程：校正预测值，得到最终的状态估计值。
通常为
x(k)=x(k|k-1)+K(k)(z(k)-Hx(k|k-1))，其中x(k|k-1)为预测值，z(k)为观测值，K(k)为卡尔曼增益。
- 1 -。
六轴传感器卡尔曼滤波计算公式卡尔曼滤波器是一种高效的递归滤波器，它只需要参数的当前状态就可以估算出下一个状态，使得计算量大大减少。
在六轴传感器（通常指的是三轴加速度计和三轴陀螺仪）的融合中，卡尔曼滤波常被用来优化和预测传感器的读数，以减少噪声和误差。
以下是简化的六轴传感器卡尔曼滤波的计算步骤和公式：预测：预测下一状态：(\hat{x}{k|k-1} = F_k \hat{x}{k-1|k-1})其中，(\hat{x}{k|k-1}) 是在 k 时刻基于 k-1 时刻的估计值预测的状态，(F_k) 是状态转移矩阵，(\hat{x}{k-1|k-1}) 是在 k-1 时刻的最优估计值。
预测估计协方差：(P_{k|k-1} = F_k P_{k-1|k-1} F_k^T + Q_k) 其中，(P_{k|k-1}) 是预测的估计协方差，(P_{k-1|k-1}) 是上一时刻的最优估计协方差，(Q_k) 是过程噪声协方差。
更新：计算卡尔曼增益：(K_k = P_{k|k-1} H_k^T (H_k P_{k|k-1} H_k^T + R_k)^{-1})其中，(K_k) 是卡尔曼增益，(H_k) 是观测模型矩阵，它将状态空间映射到观测空间，(R_k) 是观测噪声协方差。
更新估计值：(\hat{x}{k|k} = \hat{x}{k|k-1} + K_k (z_k - H_k \hat{x}{k|k-1}))其中，(\hat{x}{k|k}) 是在 k 时刻的最优估计值，(z_k) 是在 k 时刻的观测值。
更新估计协方差：(P_{k|k} = (I - K_k H_k) P_{k|k-1})其中，(P_{k|k}) 是在 k 时刻的最优估计协方差。
对于六轴传感器，状态向量 (x) 通常包括角度、角速度和可能的偏差项。
观测向量 (z) 则来自加速度计和陀螺仪的读数。
你需要为系统定义一个合适的状态转移矩阵 (F) 和观测模型矩阵 (H)，以及过程噪声协方差 (Q) 和观测噪声协方差 (R)。
一、背景---卡尔曼滤波的意义随着传感技术、机器人、自动驾驶以及航空航天等技术的不断发展，对控制系统的精度及稳定性的要求也越来越高。
卡尔曼滤波作为一种状态最优估计的方法，其应用也越来越普遍，如在无人机、机器人等领域均得到了广泛应用。
对于Kalman Filter的理解，用过的都知道“黄金五条”公式，且通过“预测”与“更新”两个过程来对系统的状态进行最优估计，但完整的推导过程却不一定能写出来，希望通过此文能对卡尔曼滤波的原理及状态估计算法有更一步的理解。
二、卡尔曼滤波的基本模型假设一离散线性动态系统的模型如下所示：x_{k} = A*x_{k-1} + B*u_{k} + w_{k-1}-------(1)z_{k} = H*x_{k} + v_{k} --------------------(2)其中，各变量表征的意义为：———————————————————————————x_{k}\Rightarrow 系统状态矩阵，-------， z_{k}\Rightarrow 状态阵的观测量（实测）A\Rightarrow 状态转移矩阵，-------， B\Rightarrow 控制输入矩阵H\Rightarrow 状态观测矩阵w_{k-1}\Rightarrow 过程噪声，-------，v_{k}\Rightarrow 测量噪声———————————————————————————如果大家学过《现代控制理论》的话，对上述模型的描述形式一定不会陌生，只是多了变量 w_{k-1} 与 v_{k} 。
其中，随机变量w_{k-1} 代表过程噪声（process noise）， v_{k} 代表测量噪声（measurement noise），且为高斯白噪声，协方差分别为 Q 和 R ，即 p(w) \in N(0,Q) ， p(v) \in N(0,R) 。
为什么要引入这两个变量呢？对于大多数实际的控制系统（如倒立摆系统）而言，它并不是一个严格的线性时变系统(Linear Time System)，亦或系统结构参数的不确定性，导致估计的状态值x_{k} 存在偏差，而这个偏差值由过程噪声 w_{k} 来表征。
卡尔曼滤波公式
卡尔曼滤波公式
X(k)=A X(k-1)+B U(k)+W(k)
卡尔曼滤波(Kalman filtering)一种利用线性系统状态方程，通过系统输入输出观测数据，对系统状态进行最优估计的算法。
由于观测数据中包括系统中的噪声和干扰的影响，所以最优估计也可看作是滤波过程。
斯坦利·施密特(Stanley Schmidt)首次实现了卡尔曼滤波器。
卡尔
曼在NASA埃姆斯研究中心访问时，发现他的方法对于解决阿波罗计划的轨道预测很有用，后来阿波罗飞船的导航电脑使用了这种滤波器。
关于这种滤波器的论文由Swerling (1958), Kalman (1960)与Kalman and Bucy (1961)发表。
数据滤波是去除噪声还原真实数据的一种数据处理技术, Kalman
滤波在测量方差已知的情况下能够从一系列存在测量噪声的数据中，估计动态系统的状态. 由于, 它便于计算机编程实现, 并能够对现场
采集的数据进行实时的更新和处理, Kalman滤波是目前应用最为广泛的滤波方法, 在通信, 导航, 制导与控制等多领域得到了较好的应用.。
