第七讲状态估计-卡尔曼滤波
卡尔曼滤波器
Ak (xk1 xˆk1 H kCk Ak (xˆk1 xk1) k1 H kCk Akk1 H k vk
(I H kCk ) Ak (xk1 xˆk1) (I H kCk )k1 H k vk
(I H kCk ) Ak (xk1 xˆk1) k1 H kvk
(2.5.17)
精品文档
第二章 维纳滤波和卡尔曼滤波
所以(xˆskuǒ1yǐ) 仅依赖于xk-1,vk-1，而与vk不相关，即 E[(xk1 xˆk1)vkT ] E[vk (xk1 xˆk1)T ] 0 (2.5.18)
E[(xk1 xˆk1)kT1] E[k1(xk1 xˆk1)T ] 0 (2.5.19)
(2.5.24)
令
U T (Pk'CkT )T Ck Pk'T Ck Pk'
(2.5.25)
精品文档
第二章 维纳滤波和卡尔曼滤波
定义:设A∈Cn×n是Hermite矩阵,如果对任意0≠x∈Cn,都有 xHAx＞0,则A是Hermite正定阵; 若xHAx≥0,则A是Hermite半正定阵.
定理(dìnglǐ):设A∈ Cn×n 是Hermite矩阵,则下列条件等价 (1)A是Hermite矩阵,AH=A (2)A的特征值全为正实数 (3)存在矩阵P ∈Cn×n,使得A=PHP
(3) 卡尔曼滤波采取的误差准则仍为估计误差的均方值最小。
精品文档
第二章 维纳滤波和卡尔曼滤波 2.5.1 卡尔曼滤波的状态方程(fāngchéng)和量测方程(fāngchéng)
假设某系统k时刻的状态变量为xk，状态方程(fāngchéng)和量 测方程(fāngchéng)（也称为输出方程(fāngchéng)）表示为
卡尔曼滤波方法
次提出的一种估计方法。之所以称为滤波，是因为它是一 种排除随机干扰，提高检测精度的一种手段。
• KF是基于最小方差准则推导出来的一种线性滤波器。 • KF是一种时域递推算法，根据上一状态的估计值和当前
状态的观测值推出当前状态，不需存储大量的历史数据， 便于计算机实现。
xˆk xˆk K( yk yˆk )
Px, k Px, k KPy, k K T
27
Xˆ k|k Xˆ k k1 Kk Z~k k1
测量更新 /修正
方差估值 Pk k [I Kk Hk ]Pk k1
7
3.5 卡尔曼滤波的结构图
上述递推公式，称为卡尔曼滤波器。实际上，卡尔曼 滤波器也是一个系统，其结构框图如下：
Zk + -
+
Kk
+
Z k|k 1
当前估计值
Xˆ k
14
3.7 联邦卡尔曼滤波
• 卡尔曼滤波最成功的工程应用是设计运载体的高精度组合
导航系统。为了与联邦滤波方法相区别，将普通的卡尔曼
滤波称为集中卡尔曼滤波。
• 由于对导航精度要求的提高，导航设备越来越多。另一方
面，现代系统向大系统和复杂系统的方向发展。这种情况
下采用集中式卡尔曼实现组合导航，存在两个问题：
yˆ
k
W (m) i
i
k|k 1
i0
2n
Py, k
Wi
(c)
[
i k|k
1
yˆ k
][
i k|k 1
yˆk ]T
卡尔曼滤波原理
卡尔曼滤波原理
卡尔曼滤波是一种用于估计系统状态的递归滤波器。
它可以通过组合系统的测量值和模型的预测值来提供对状态的最优估计。
卡尔曼滤波器首先利用系统的数学模型预测下一个状态，并计算预测值与实际测量值之间的差异。
然后，通过加权这些差异，卡尔曼滤波器可以生成对当前状态的最佳估计。
卡尔曼滤波的核心原理是“最小均方误差”。
它假设系统状态和观测都是高斯分布，然后尝试寻找最小均方误差的估计值。
通过选择合适的权重，卡尔曼滤波器可以在预测值和测量值之间找到一个平衡，从而提供最佳的估计结果。
卡尔曼滤波器由两个主要步骤组成：预测和更新。
在预测步骤中，卡尔曼滤波器使用系统模型和先前的状态估计来预测下一个状态。
然后，在更新步骤中，卡尔曼滤波器将测量值与预测值进行比较，并使用加权平均法来更新状态估计。
通过周期性地重复这两个步骤，卡尔曼滤波器可以连续地提供对系统状态的估计。
卡尔曼滤波器在估计问题中广泛应用，特别是在传感器融合、航空航天和导航系统中。
它能够有效地处理噪声和不确定性，并在给定系统模型和测量信息的情况下提供最优的状态估计。
卡尔曼滤波起源发展原理及应用
附录：kalman滤波（起源、发展、原理、应用）1、Kalman滤波起源及发展1960年，匈牙利数学家卡尔曼发表了一篇关于离散数据线性滤波递推算法的论文，这意味着卡尔曼滤波的诞生。
斯坦利.施密特(Stanley Schmidt)首次实现了卡尔曼滤波器，卡尔曼在NASA埃姆斯研究中心访问时，发现他的方法对于解决阿波罗计划的轨道预测很有用，后来阿波罗飞船的导航电脑使用了这种滤波器。
关于这种滤波器的论文由Swerling (1958)、Kalman (1960)与Kalman and Bucy (1961)发表.卡尔曼滤波是一种有着相当广泛应用的滤波方法，但它既需要假定系统是线性的，又需要认为系统中的各个噪声与状态变量均呈高斯分布，而这两条并不总是确切的假设限制了卡尔曼滤波器在现实生活中的应用。
扩展卡尔曼滤波器（EKF）极大地拓宽了卡尔曼滤波的适用范围。
EKF的基本思路是，假定卡尔曼滤滤对当前系统状态估计值非常接近于其真实值，于是将非线性函数在当前状态估计值处进行台劳展开并实现线性化。
另一种非线性卡尔曼滤波叫线性化卡尔曼滤波。
它与EKF的主要区别是前者将非线函数在滤波器对当前系统状态的最优估计值处线性化，而后者因为预先知道非线性系统的实际运行状态大致按照所要求、希望的轨迹变化，所以这些非线性化函数在实际状态处的值可以表达为在希望的轨迹处的台劳展开式，从而完成线性化。
不敏卡尔曼滤波器（UKF）是针对非线性系统的一种改进型卡尔曼滤波器。
UKF处理非线性系统的基本思路在于不敏变换，而不敏变换从根本上讲是一种描述高斯随机变量在非线性化变换后的概率分布情况的方法。
不敏卡尔曼滤波认为，与其将一个非线性化变换线性化、近似化，还不如将高斯随机变量经非线性变换后的概率分布情况用高斯分布来近似那样简单，因而不敏卡尔曼滤波算法没有非线性化这一步骤。
在每一定位历元，不敏卡尔曼滤波器按照一套公式产生一系列样点，每一样点均配有一个相应的权重，而这些带权的样点被用来完整地描述系统状态向量估计值的分布情况，它们替代了原先卡尔曼滤波器中的状态向量估计值及协方差。
卡尔曼滤波
位移均方差
速度均方差
卡尔曼滤波简介
目录 Contents源自 一. 二. 三. 四.
背景简介 Kalman 滤波理论基础介绍及应用 Kalman 滤波在自由落体运动目标跟踪中的应用 MATLAB仿真程序及结果
背景简介
匈牙利数学家 1930年出生于匈牙利首都布达佩斯。 1953，1954年于麻省理工学院分别 获得电机工程学士及硕士学位。 1957年于哥伦比亚大学获得博士学位。 1960年发表的论文《A New Approach to Linear Filtering and Prediction Problems》（线性滤波 与预测问题的新方法）
卡尔曼滤波理论介绍
假如我们要估算k时刻的是实际温度值。首先你要根 据k-1时刻的温度值，来预测k时刻的温度。因为你 相信温度是恒定的，所以你会得到k时刻的温度预测 值是跟k-1时刻一样的，假设是23度，同时该值的高 斯噪声的偏差是5度（5是这样得到的：如果k-1时刻 估算出的最优温度值的偏差是3，你对自己预测的不 确定度是4度，他们平方相加再开方，就是5）。然 后，你从温度计那里得到了k时刻的温度值，假设是 25度，同时该值的偏差是4度。 由于我们用于估算k时刻的实际温度有两个温度值， 分别是23度和25度。
Kalman滤波在自由落体运动目标跟 踪中的应用
其中递推关系式为： T P ( k ) AP ( k 1) A Q(k 1) 1 T T 1 K (k ) P ( k ) C [ CP ( k ) C R ] 1 1 P(k ) P 1 ( k ) K ( k )CP 1 (k ) 估计器表达式，把它分成两部分，前者为预测，后者 (k ) Ax (k 1) K(k)[y(k) CA x (k 1)] 为修正：x 第k时刻的估计是由k-1时刻的预测值加上修正量得到的， (k 1/ k ) Ax (k ) k+1时刻的预测值： x Kalman预测器为: (k 1/ k ) Ax (k ) A{A x (k 1) K(k)[y(k) CA x (k 1)]} x
卡尔曼滤波法
卡尔曼滤波法卡尔曼滤波法是指一种基于相关理论的有状态估计技术，它有效地融合已知信息和新观测信息，以确定系统内部状态如位置、速度和加速度等。
一、特点1、适用于高维系统：卡尔曼滤波能够在高维系统状态空间中进行有效滤波。
2、易于实现：卡尔曼滤波一般采用分块矩阵，以便在离散时间序列上进行数值计算，从而使估计工作更加便捷。
3、具有自适应性：系统变化或者观测值的不确定性时，卡尔曼滤波算法能够自动调整估计系数，从而实现准确的估计。
二、原理卡尔曼滤波尝试将状态空间中的信息和观测数据结合，来估计系统的状态变量，它有两个基本阶段:状态预估和状态校正。
首先，采用现有的状态信息和系统模型，利用预测模型来预测可能的状态取值。
然后，通过观测数据，不断更新这些状态估计值，使估计值更加准确。
三、应用1、航空航天：卡尔曼滤波算法被广泛应用于气球导航中，可以对空中对象的位置、速度、加速度等敏感参数进行更精准的测量。
2、自动控制：卡尔曼滤波算法用于控制系统建模，可以用于制定自动跟踪控制程序，实现实时系统参数调节。
3、惯性导航：卡尔曼滤波算法用于飞行器间机动状态的跟踪，对于导弹、衛星等航空器定位和姿态测量提供有效的解决方案。
4、机器人：卡尔曼滤波可以应用于机器人的自运动控制，可以帮助机器人在复杂环境中精准定位。
四、优缺点优点：1、结构灵活：卡尔曼滤波因为结构灵活的缘故，可以容易地应用于各种复杂的有状态系统。
2、收敛速度快：卡尔曼滤波收敛速度快、具有自适应性，可以进行准确的状态估计。
缺点：1、需要假定系统模型：卡尔曼滤波可以实现有效的数据融合，但需要满足一定的系统假定。
2、状态估计的不稳定性：卡尔曼滤波的状态估计结果受观测信息的影响很大，估计值可能受到观测噪声的很大影响。
卡尔曼滤波 详解
卡尔曼滤波详解卡尔曼滤波(Kalman Filter)是一种用于估计系统状态的算法，广泛应用于控制系统、信号处理、机器人导航等领域。
卡尔曼滤波的核心思想是利用系统的动态模型和测量数据的信息来对系统状态进行估计，同时最小化估计误差的方差。
在实际应用中，卡尔曼滤波能够对系统状态进行高效、准确的估计，并具有良好的鲁棒性和适应性。
卡尔曼滤波的核心思想可以简单概括为“测量并补偿”，即先通过传感器测量得到当前的状态信息，然后利用系统动态模型来预测下一时刻的状态，再将测量值与预测值进行比较，通过加权平均的方式得到最终的估计值。
要实现这个过程，需要建立卡尔曼滤波的基本模型，包括状态转移方程、观测方程、协方差矩阵和初始状态。
卡尔曼滤波的核心步骤包括预测阶段和更新阶段。
预测阶段主要利用系统动态模型对状态进行预测，以及计算预测误差的方差。
预测阶段包括以下几个步骤：1. 状态预测：根据系统动态模型和当前状态估计值，预测下一时刻的状态估计值。
2. 协方差预测：根据系统动态模型和当前状态协方差矩阵，预测下一时刻的协方差矩阵。
3. 估计误差的量化：计算预测值与真实值之间的估计误差，以及预测误差的方差。
更新阶段主要利用测量数据对状态进行修正，以及更新协方差矩阵。
更新阶段包括以下几个步骤：1. 估计增益：根据协方差矩阵和观测噪声方差，计算估计值与观测值之间的加权比例。
2. 状态修正：利用估计增益和测量值对状态进行修正。
3. 协方差修正：利用估计增益对协方差矩阵进行修正。
卡尔曼滤波的应用非常广泛，包括导航系统、车辆控制、信号处理、自动驾驶、机器人导航等领域。
卡尔曼滤波能够对系统状态进行高效、准确的估计，并且具有良好的鲁棒性和适应性，对噪声和误差具有较好的鲁棒性。
此外，卡尔曼滤波具有良好的数学基础和理论支撑，能够直接应用于许多复杂的系统中。
卡尔曼滤波状态估计步骤
卡尔曼滤波状态估计步骤哎呀，这卡尔曼滤波啊，真是个让人头疼的玩意儿。
不过，别急，咱们慢慢聊聊，就像咱们在咖啡馆里闲聊一样。
首先，得说，卡尔曼滤波这玩意儿，就像是你有个朋友，他总是给你发位置信息，但是呢，这信息有时候准，有时候不准。
你呢，就得用这个卡尔曼滤波来猜他到底在哪儿。
听起来是不是挺有意思的？咱们先从第一步说起，就是初始化。
这就像是你刚认识这个朋友，你对他的了解还不多，只能根据他给你的第一个信息，也就是位置，来猜测他在哪儿。
这时候，你心里可能有点没底，因为你不知道这个信息有多靠谱，所以你会给他一个“不确定性”的标签，比如，你可能会想：“这家伙是不是在跟我开玩笑呢？”接下来，就是预测步骤了。
这就像是你根据你朋友以前给你的信息，来预测他下一步会去哪儿。
比如，你知道他每天下班都会去公园散步，所以今天你也会猜他可能还会去那儿。
但是，你心里还是有点不确定，因为人嘛，总有变数，对吧？然后，就是更新步骤了。
这一步最有意思，就像是你朋友突然给你发了一条信息，告诉你他现在在公园的长椅上坐着。
这时候，你得重新评估他的位置，因为你有了新的信息。
你得把之前的猜测和新的消息结合起来，就像是你在地图上画了两条线，然后找到它们的交点，这个交点，就是你朋友现在最可能的位置。
最后，就是评估不确定性。
这就像是你在更新位置后，还得想想：“这次的消息靠谱吗？我是不是还得留点余地？”所以，你会给你的新位置再打个“不确定性”的标签，这个标签会根据新旧信息的靠谱程度来调整。
你看，卡尔曼滤波就是这么个过程，就像是你在和朋友玩捉迷藏，你得根据他给你的线索，一步步猜他在哪儿。
虽然有时候可能会猜错，但是通过不断地更新和调整，你会越来越接近他的真实位置。
所以，卡尔曼滤波，其实就是个不断猜测和修正的过程，就像我们在生活中不断调整自己的判断一样。
虽然听起来有点复杂，但其实就跟我们平时聊天、猜测朋友心思差不多，挺有意思的，对吧？好了，聊了这么多，你是不是对卡尔曼滤波有点儿感觉了呢？其实，它并不像听起来那么高深莫测，它就像是我们日常生活中的一个小插曲，充满了不确定性和惊喜。
卡尔曼滤波讲解
卡尔曼滤波器的简介
卡尔曼全名Rudolf Emil Kalman，匈牙利数学家， 1930年出生于匈牙利首都布达佩斯。1953， 1954年于麻省理工学院分别获得电机工程学士 及硕士学位。1957年于哥伦比亚大学获得博士 学位。我们现在要学习的卡尔曼滤波器，正是 源于他的博士论文和1960年发表的论文《A New Approach to Linear Filtering and Prediction Problems》（线性滤波与预测问题的新方法）。
y(k)是k时刻的测量值，
H是测量系统的参数，对于多测量系 统，H为矩阵。
系统噪声和测量噪声都是高斯分布的， q(k)和r(k)分别表示过程和测量的噪声。
协方差矩阵分别为Qk-1和Rk
他们被假设成高斯白噪声(White
Gaussian Noise)，他们的covariance分
别是Q，R（这里我们假设他们不随
扩展Kalman滤波算法(EKF)
假定定位跟踪问题的非线性状态方程和测量方程如下:
X f (X ) W ...............(1)
k 1
k
k
Y h(X ) V ...................(.2)
k
k
k
在最近一次状态估计的时刻，对以上两式进行线性化处理，首先构造如 下2个矩阵:
卡尔曼滤波(Kalman Filter)原理与公式推导
一、背景---卡尔曼滤波的意义随着传感技术、机器人、自动驾驶以及航空航天等技术的不断发展，对控制系统的精度及稳定性的要求也越来越高。
卡尔曼滤波作为一种状态最优估计的方法，其应用也越来越普遍，如在无人机、机器人等领域均得到了广泛应用。
对于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} 来表征。
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
ˆ X = ∑ hi zi
i =1
m
当h1=h2=…=hm=1/m时， 时
1 m ˆ X = ∑ zi m i =1
ˆ 是用m个采样值的平均值作为被估参量 该式表明， 个采样值的平均值作为被估参量x的 该式表明，估计 X 是用 个采样值的平均值作为被估参量 的
近似值的，故称其为采样平均估值器。 近似值的，故称其为采样平均估值器。
18
自动化学院
NUST
智能信息处理技术
二、线性均方估计
1、最优非递归估计（标量维纳滤波） 最优非递归估计（标量维纳滤波） 2、递归估计
19
自动化学院
NUST
智能信息处理技术
1. 最优非递归估计 最优非递归估计 非递归滤波器的估计值及其估计误差可分别表示为
ˆ X = ∑ hi zi
i =1
m
ˆ − x ) 2 ] = E[( ∑ hi zi − x ) 2 ] Pε = E[( X
15
自动化学院
NUST
智能信息处理技术
递归数字滤波器是一种带有反馈的滤波器， 递归数字滤波器是一种带有反馈的滤波器，它有无限的脉 冲响应，有阶数少的优点， 但其暂态过程较长。 冲响应，有阶数少的优点， 但其暂态过程较长。关于信号和噪 声的基本假设与非递归情况相同。 声的基本假设与非递归情况相同。上图给出的一阶递归滤波器 输入输出信号关系如下： 输入输出信号关系如下：
hi (k ) = hi (k + 1) =
所以有
Pε (k )
σ
2 n
= bk = bk +1
Pε (k + 1)
σ
2 n
bk +1 k +b 1 = = bk k + b + 1 1 + 1 /(k + b)
23
bk bk +1 = 1 + bk
自动化学院
NUST
智能信息处理技术
于是, 于是
ˆ X k +1 = bk +1 ∑ zi
10
自动化学院
NUST
智能信息处理技术
根据数字信号处理我们知道，所谓非递归数字滤波器是一 根据数字信号处理我们知道， 种只有前馈而没有反馈的滤波器，它的冲击脉冲响应是有限的， 种只有前馈而没有反馈的滤波器，它的冲击脉冲响应是有限的， 在许多领域有着广泛的应用。 在许多领域有着广泛的应用。 假定用z 表示观测值， 假定用 k表示观测值，
智能信息处理技术
第七讲 状态估计—卡尔曼滤波 状态估计 卡尔曼滤波
智能信息处理技术
状态估计的主要内容
应用： 应用： 通过数学方法寻求与观测数据最佳拟合的状态 向量。 向量。 1、确定运动目标的当前位置与速度； 确定运动目标的当前位置与速度； 2、确定运动目标的未来位置与速度； 确定运动目标的未来位置与速度； 3、确定运动目标的固有特征或特征参数。 确定运动目标的固有特征或特征参数。
卡尔曼滤波器的应用特点
对机动目标跟踪中具有良好的性能； 对机动目标跟踪中具有良好的性能； 为最佳估计并能够进行递推计算； 为最佳估计并能够进行递推计算； 只需当前的一个测量值和前一个采样周期的预测 值就能进行状态估计。 值就能进行状态估计。
7
自动化学院
NUST
智能信息处理技术
卡尔曼滤波器的局限性
卡尔曼滤波器解决运动目标或实体的状态估计问 题时，动态方程和测量方程均为线性。 题时，动态方程和测量方程均为线性。
1 2 σn m+b
其中，b=σ2n/σ2x， 在b<<m时，这种估计近似于采样平均。在噪 其中 ， 时 这种估计近似于采样平均。 声方差σ 较大时，其性能明显优于非最佳情况。 声方差 2n较大时，其性能明显优于非最佳情况。这种最小均方 误差准则下的线性滤波，通常称作标量维纳滤波。 误差准则下的线性滤波，通常称作标量维纳滤波。 hj与非最优情况的不同，这里的滤波器的加权系数为 与非最优情况的不同，
i =1
k +1
分成二项： 分成二项：
ˆ X k +1 = bk +1 ∑ zi + bk +1 zk +1
i =1
k +1
将第一项同时乘、除一个 将第一项同时乘、除一个bk，则
24
bk +1 k +1 bk +1 ˆ ˆ k +1 = X ∑ bk zi + bk +1zk +1 = b X k + bk +1zk +1 bk i =1 k
ˆ X k = (1 − a ) yk
则
17
ˆ X k = (1 − a k ) x + (1 − a )∑ a k −i ni
i =1
k
自动化学院
NUST
智能信息处理技术
此时信号x和估值之间只差一个噪声项。 值较大时， 此时信号 和估值之间只差一个噪声项。当k值较大时， 和估值之间只差一个噪声项 值较大时 估值的均方误差
12
自动化学院
NUST
智能信息处理技术
估计的均方误差以P 表示， 估计的均方误差以 ε表示，有
1 2 2 ˆ Pε = E (ε ) = E ( X − x ) = E 2 m
[
]
1 ∑∑ n j ni = m2 j =1 i =1
m m
2 σ n δ ji ∑∑ j i
yk = ayk −1 + zk zk = x + nk
式中，zk与非递归情况相同；a是一个小于 的滤波器加权系数， 式中， 与非递归情况相同； 是一个小于1的滤波器加权系数， 是一个小于 的滤波器加权系数 如果它大于或等于1， 该滤波器就不稳定了。 如果它大于或等于 ， 该滤波器就不稳定了。
如果E(x)=0，可从零开始递推运算，即 ，可从零开始递推运算， 如果
ˆ X0 = 0
σ 1 b0 = = σ b
2 x 2 n
28
自动化学院
NUST
智能信息处理技术
三、标量卡尔曼滤波器－时变信号 标量卡尔曼滤波器－
主要作用： 主要作用： 对掺杂有噪声的随机信号进行线性估计。 对掺杂有噪声的随机信号进行线性估计。
16
自动化学院
NUST
智能信息处理技术
k时刻的输出： 时刻的输出： 时刻的输出
yk=ak-1z1+ak-2z2+…+azk-1+zk
中的信号和噪声分开，并代入， 将zk中的信号和噪声分开，并代入，有输出 k 1 − ak yk = x + ∑ a k −i ni 1− a i =1 由于│a│＜1， 故随着 值的增加 ， yk 趋近于 ＜ ， 故随着k值的增加 值的增加， 趋近于x/(1-a)。 这样 ， 如 由于 。 这样， 果以(1-a)yk作为 的估计值， 作为x的估计值 的估计值， 果以
2
自动化学院
NUST
智能信息处理技术
状态估计主要内容：位置与速度估计。 状态估计主要内容：位置与速度估计。 位置估计：距离、方位和高度或仰角的估计； 位置估计：距离、方位和高度或仰角的估计； 速度估计：速度、加速度估计。 速度估计：速度、加速度估计。
3
自动化学院
NUST
智能信息处理技术
状态估计的主要方法
^
26
自动化学院
NUST
智能信息处理技术
最优递归估计器
递推公式
X k +1 = X k + bk +1 ( z k +1 − X k )
27
^
^
^
自动化学院
NUST
智能信息处理技术
ˆ 递推开始时的初始条件 X 0 应满足 ：
ˆ ∂E [( x − X 0 )2 ] =0 ˆ0 ∂X ˆ 为最佳值。 解之，得 X = E ( x ) ，这时的 P = σ 2 ˆ0 为最佳值。 解之， 以使 X 0 ε x
29
自动化学院
NUST
智能信息处理技术
1、模型 、模型
1） 信号模型 ） 信号模型 设要估计的随机信号为由均值为0，方差为σ 设要估计的随机信号为由均值为 ，方差为 2w的白噪声激 励的一个一阶递归过程，即信号对时间变化满足动态方程： 励的一个一阶递归过程，即信号对时间变化满足动态方程： x(k)=ax(k-1)+w(k-1) 式中， 系统参数； 式中，a——系统参数； 系统参数 w(k-1)——白噪声采样。 白噪声采样。 白噪声采样 如果令x(0)=0，E［w(k)］=0， 则 ， ［ 如果令 ］ ，
^
ˆ ) = E 1 ∑ ( x + ni ) = E ( x ) = x0 E( X m i =1
m
14
自动化学院
NUST
智能信息处理技术
2、递归估值器
一阶递归估值器： 一阶递归估值器：
yk zk ＋ ∑ z－1 1－a
ˆ Xk
＋
a
a为滤波器的加权系数，a<1。 为滤波器的加权系数，a<1。
5
自动化学院
NUST
智能信息处理技术
卡尔曼滤波器
卡尔曼滤波器的应用: 卡尔曼滤波器的应用: 通信、雷达、导航、自动控制等领域； 通信、雷达、导航、自动控制等领域； 航天器的轨道计算、雷达目标跟踪、生产过程的自 航天器的轨道计算、雷达目标跟踪、 动控制等。 动控制等。
6
自动化学院
NUST
智能信息处理技术
8
自动化学院
NUST
智能信息处理技术
一、数字滤波器作估值器
1、非递归估值器 2、递归估值器
9
自动化学院