基于变维滤波算法的Kalman最佳平滑器在滑坡监测数据处理中的应用
卡尔曼滤波算法在二维坐标的预测与平滑的应用实例

卡尔曼滤波算法在二维坐标的预测与平滑的应用实例卡尔曼滤波算法在二维坐标的预测与平滑的应用可以用于目标跟踪、无人机自主导航、移动机器人定位等领域。
以下是一个目标跟踪的应用实例:
假设有一个移动目标在二维平面上运动,通过传感器可以获取到目标的位置信息。
然而由于传感器的误差、测量噪声以及目标的运动不确定性等因素,获取到的位置信息可能存在一定的误差。
使用卡尔曼滤波算法对目标位置进行预测与平滑处理可以提高跟踪的准确性和
稳定性。
预测过程:
1. 状态变量:定义目标在二维平面上的位置状态变量,例如(x, y)表示目标的坐标。
2. 状态转移矩阵:根据目标的运动模型,创建状态转移矩阵F,例如简化的线
性模型可以使用单位矩阵。
3. 过程噪声协方差矩阵:根据目标的运动模型和运动的不确定性,创建过程噪声协方差矩阵Q,衡量预测过程中的不确定性。
4. 预测:根据上一时刻的状态估计和状态转移矩阵,使用卡尔曼滤波的预测公式进行预测。
更新过程:
1. 观测矩阵:定义观测矩阵H,将状态变量映射到实际的观测值。
例如,可以直接使用单位矩阵,表示观测值等于状态值。
2. 观测噪声协方差矩阵:根据传感器的精度和测量噪声,创建观测噪声协方差矩阵R,衡量测量过程中的不确定性。
3. 测量更新:根据当前时刻的观测值和预测结果,使用卡尔曼滤波的测量更新公式进行更新。
通过反复进行预测和更新过程,可以实现对目标运动的连续跟踪,并能有效抑制噪声,提高位置估计的准确性和稳定性。
卡尔曼(kalman)滤波算法特点及其应用

Kalman滤波算法的特点:(1)由于Kalman滤波算法将被估计的信号看作在白噪声作用下一个随机线性系统的输出,并且其输入/输出关系是由状态方程和输出方程在时间域内给出的,因此这种滤波方法不仅适用于平稳随机过程的滤波,而且特别适用于非平稳或平稳马尔可夫序列或高斯-马尔可夫序列的滤波,所以其应用范围是十分广泛的。
(2)Kalman滤波算法是一种时间域滤波方法,采用状态空间描述系统。
系统的过程噪声和量测噪声并不是需要滤除的对象,它们的统计特征正是估计过程中需要利用的信息,而被估计量和观测量在不同时刻的一、二阶矩却是不必要知道的。
(3)由于Kalman滤波的基本方程是时间域内的递推形式,其计算过程是一个不断地“预测-修正”的过程,在求解时不要求存储大量数据,并且一旦观测到了新的数据,随即可以算的新的滤波值,因此这种滤波方法非常适合于实时处理、计算机实现。
(4)由于滤波器的增益矩阵与观测无关,因此它可预先离线算出,从而可以减少实时在线计算量。
在求滤波器增益矩阵时,要求一个矩阵的逆,它的阶数只取决于观测方程的维数,而该维数通常很小,这样,求逆运算是比较方便的。
另外,在求解滤波器增益的过程中,随时可以算出滤波器的精度指标P,其对角线上的元素就是滤波误差向量各分量的方差。
Kalman滤波的应用领域一般地,只要跟时间序列和高斯白噪声有关或者能建立类似的模型的系统,都可以利用Kalman滤波来处理噪声问题,都可以用其来预测、滤波。
Kalman滤波主要应用领域有以下几个方面。
(1)导航制导、目标定位和跟踪领域。
(2)通信与信号处理、数字图像处理、语音信号处理。
(3)天气预报、地震预报。
(4)地质勘探、矿物开采。
(5)故障诊断、检测。
(6)证券股票市场预测。
具体事例:(1)Kalman滤波在温度测量中的应用;(2)Kalman滤波在自由落体运动目标跟踪中的应用;(3)Kalman滤波在船舶GPS导航定位系统中的应用;(4)Kalman滤波在石油地震勘探中的应用;(5)Kalman滤波在视频图像目标跟踪中的应用;。
卡尔曼滤波在数据处理中的应用

卡尔曼滤波在数据处理中的应用在现代科技发展的背景下,大数据处理技术已经成为了企业和个人重要的运营手段之一。
但是,由于数据来源的不确定性和数据的不确定性,使得数据处理的结果很容易受到干扰和误差。
因此,如何让数据处理结果更加准确和稳定,成为了大数据处理技术的关键。
在众多数据处理技术中,卡尔曼滤波(Kalman Filter)因其独特的优点而备受推崇,成为了数据处理领域中不可或缺的技术之一。
一、什么是卡尔曼滤波卡尔曼滤波是一种基于线性系统与随机过程理论的优化算法,在状态预测、系统诊断等领域有着广泛的应用。
它主要是利用观测数据来推断潜在的状态变量,通过对测量值与模型之间的比较,不断优化模型的预测结果。
它是一种具有递归、自校正、自适应和最优权衡等特点的算法,在实际应用中很有效。
卡尔曼滤波主要有两个要义,一个是用数学手段提取观测数据中的有效信号; 一个是在系统状态随时间演变的过程中,利用观测数据对系统状态做出动态估计,实现对未来的预测。
两个要义相辅相成,通过对信号和系统状态的优化,卡尔曼滤波可以在很多应用场景下提高数据处理的准确性。
二、卡尔曼滤波在数据处理中的应用1. 信号处理在信号处理领域中,卡尔曼滤波可以用于测量,过滤和预测等多个方面。
卡尔曼滤波通过不断的递归运算,可以提取出信号中的有效信息,降低数据中的噪声和干扰。
同时,卡尔曼滤波可以对信号的未来走向做出预测,为为后续的决策和分析提供支持。
因此,卡尔曼滤波在通信、雷达、声纳等领域具有广泛的应用。
2. 图像处理在图像处理领域中,卡尔曼滤波可以用于图像去噪、目标跟踪和特征提取等方面。
卡尔曼滤波主要是利用模型来描述目标的运动状态,并且通过不断修正模型中的参数,确定目标的真实位置,提高测量的准确性。
同时,卡尔曼滤波可以预测目标的运动趋势,为目标跟踪提供更加坚实的基础。
因此,卡尔曼滤波在图像处理中有着广泛的应用。
3. 机器人定位和导航在机器人定位和导航领域中,卡尔曼滤波可以用于机器人自身状态估计和控制。
卡尔曼滤波应用实例

卡尔曼滤波应用实例1. 介绍卡尔曼滤波是一种状态变量滤波技术,又称为按时间顺序处理信息的最优滤波。
最初,它是由罗伯特·卡尔曼(Robert Kalman)在国防领域开发的。
卡尔曼滤波是机器人领域中常用的滤波技术,用于估计变量,如机器人位置,轨迹,速度和加速度这些有不确定性的变量。
它利用一组测量值,通过机器学习的形式来观察目标,以生成模糊的概念模型。
2. 应用实例(1) 航迹跟踪:使用卡尔曼滤波可以进行航迹跟踪,这是一种有效的状态估计技术,可以处理带有动态噪声的状态变量跟踪问题。
它能够在航迹跟踪中进行有效的参数估计,而不受环境中持续噪声(如气动噪声)的影响。
(2) 模糊控制:模糊控制是控制系统设计中的一种重要方法,可用于解决动态非线性系统的控制问题。
卡尔曼滤波可用于控制模糊逻辑的控制政策估计。
它能够以更低的复杂性和高的控制精度来解决非线性控制问题,是一种高度有效的模糊控制方法(3) 定位和导航:使用卡尔曼滤波,可以实现准确的定位和导航,因为它可以将具有不确定性的位置信息转换为准确可信的信息。
这对于记录机器人的行走路径和定位非常重要,例如机器人搜索和地图构建中可以使用卡尔曼滤波来实现准确的定位和导航。
3. 结论从上文可以看出,卡尔曼滤波是一种非常强大的滤波技术,可以有效地解决各种由动态噪声引起的复杂问题。
它能够有效地解决估计(如机器人的位置和轨迹),控制(模糊控制)和定位(定位和导航)方面的问题。
而且,卡尔曼滤波技术具有计算速度快,参数估计效果好,能有效弥补传感器误差,还能够避免滤波状态混淆,精度较高等特点,可以在很多领域中广泛应用。
Kalman滤波在工程中的应用

Kalman滤波在工程中的应用Kalman滤波在工程中的应用Kalman滤波是一种常用于工程中的估计和控制问题的优秀方法。
它使用统计学方法和线性系统理论来估计未知变量的状态,通过将测量值与模型预测进行加权平均,提供更准确和可靠的结果。
在工程领域,Kalman滤波广泛应用于航空航天、导航系统、机器人、自动驾驶和信号处理等方面。
以下是使用Kalman滤波的步骤:1. 建立模型:首先,我们需要建立一个数学模型来描述系统的动态行为。
这可以是一个线性或非线性模型,以及关于系统状态和测量值的方程。
例如,在自动驾驶中,我们可以使用车辆动力学方程来描述汽车的运动。
2. 初始化:在开始使用Kalman滤波之前,我们需要初始化系统状态估计值和协方差矩阵。
通常,我们将初始状态设置为零,协方差矩阵设置为较大的值,以表示对初始状态的不确定性。
3. 预测:通过使用系统模型,我们可以预测下一个时刻的状态和协方差矩阵。
这是通过将当前状态和模型方程进行线性组合得到的。
预测结果提供了系统状态的最佳猜测,但仍然受到噪声和不确定性的影响。
4. 更新:在此步骤中,我们使用传感器测量值来更新状态估计和协方差矩阵。
首先,我们计算测量残差,即测量值与预测值之间的差异。
然后,通过卡尔曼增益将测量残差与预测误差相结合,以获得修正后的状态估计值和协方差矩阵。
5. 重复:通过不断重复预测和更新步骤,我们可以不断改进状态估计值的准确性。
每一次迭代都会减少状态估计的不确定性,并提供更可靠的结果。
通过以上步骤,Kalman滤波可以在工程中提供准确的状态估计和控制。
它可以帮助我们从受噪声和不确定性影响的测量中提取有用的信息,以便更好地理解和控制系统的行为。
通过将预测和测量步骤相结合,Kalman滤波使得我们能够实时地更新状态估计值,并在不断迭代中逐渐减小估计误差。
总而言之,Kalman滤波在工程中具有广泛的应用。
它可以提高系统的鲁棒性和稳定性,同时也能够减少传感器噪声和测量误差的影响。
卡尔曼滤波和滑动平均滤波

卡尔曼滤波和滑动平均滤波是两种常用的滤波方法,它们在处理数据时具有不同的特性和应用场景。
卡尔曼滤波是一种递归滤波方法,通过观测一系列的噪声来对输入的数据序列进行滤波。
它具有预测和更新两个步骤,能够根据当前和过去的测量值来估计状态变量的最优值,并在每次迭代中递归地更新估计值。
卡尔曼滤波在处理具有高斯分布的线性动态系统时具有优良的性能,广泛应用于导航、制导、控制系统分析和信号处理等领域。
滑动平均滤波则是另一种常用的滤波方法,适用于处理非平稳信号。
滑动平均滤波器在处理数据时,会取固定长度的窗口内的数据,计算其平均值,并将该平均值作为输出。
随着数据的移动,窗口内的数据会不断更新,因此被称为滑动平均。
滑动平均滤波器在处理周期性信号时特别有效,因为它能够平滑信号中的突变和噪声。
总的来说,卡尔曼滤波和滑动平均滤波都是数据处理中常用的技术,选择哪种方法取决于具体的应用场景和数据处理需求。
卡尔曼滤波算法平滑轨迹

卡尔曼滤波算法平滑轨迹
卡尔曼滤波算法可以用于平滑轨迹。
下面是使用卡尔曼滤波算法平滑轨迹的一般步骤:
1. 收集观测数据:首先需要收集到需要平滑的轨迹的观测数据,可以是一系列离散的位置点。
2. 初始化卡尔曼滤波器:需要初始化卡尔曼滤波器的状态向量和协方差矩阵。
状态向量包含位置和速度的估计值,协方差矩阵表示状态估计的不确定性。
3. 预测阶段:根据当前的状态估计和系统模型,使用卡尔曼滤波的预测方程来预测下一个状态的估计值。
4. 更新阶段:收到下一个观测点后,使用卡尔曼滤波的更新方程来更新状态估计和协方差矩阵。
更新方程将观测值与预测值进行比较,根据比较结果进行判断,以及调整状态估计和协方差矩阵。
5. 重复预测和更新阶段:继续进行预测和更新阶段,直到所有的观测数据都被处理完。
通过以上步骤,可以使用卡尔曼滤波算法平滑轨迹。
卡尔曼滤波算法通过预测和更新的过程,可以有效地估计轨迹的真实值,并且考虑到观测的误差和系统模型的不确定性,提供了较为精确的估计结果。
自适应Kalman滤波在GPS变形监测数据处理中的应用

过利用预测残差对状态噪声协方差向量进行修正 , 计 算 出接近 实 际 的状 态 向量 。其 基 本 思 路如 下 : 离 散 线性 系统 卡尔 曼 滤 波 包 含 状 态 方 程 和 观测 方 程 , 如 果不 考虑 状 态 方 程 和 观 测 方 程 中 的 非 随 机 控 制 项 ,a a 滤波的函数模型状态方程 ( Kl n m 动态方程) 和
张福 荣 , 王
摘
涛
(陕西铁路工程职业技术学 院 , 陕西 渭南 74 0 ) 100 要 :P G S测量技术 在变形监测 中得 到了越 来越广泛 的应用 , 由于其误差来 源及误差对信号 的影响程度与传统 但
的监 测方法有着本质的 区别 , 如果在数据处 理中仍 然按照传统的方法 , 能得不到 满意 的监 测结果 。卡尔曼 滤波在 可 数学 上是一种统计估算方法 , 通过处理一 系列带 有误 差的实 际量测 数据 而得到 物理参 数 的最佳估值 。因此 K la a n m
cv X , O o( o△ )= 其 中 D ( )D ( ) n k 、 a k 分别 为动态噪声和观测噪 声 的方 差 阵 ;茸 Koekr函数 , 『 k时 , =1 是 rnee 当- = ; 当j #k时 , = 。上 述 模 型 的动 态 噪声 和观 测 噪 0
EA) ( cy , )=% ( o( )
cv z , )= a k 8 o (  ̄ D ( )茸 CY ,j =0 O ( A. )
() 2
E( 0 / ( ) X )=z 0 vrX )=D ( ) a( o x O
CV X , )= O ( o 0
观 测方程 :
+1 =
,
声都是零均值 白噪声序列 , 且它们之 问在任何 时刻 都不 相关 , 以上 述 模 型 也 称 为完 全 不 相 关 的 白噪 所 声作 用下 的卡尔 曼滤 波 。 对 于离 散 线 性 系 统 的状 态 估计 问题 , 以应 用 可 最小方差估计或极大验后估计原理来导出求估值的 卡尔曼滤波方程 , 也可 以应用广义最/ -乘原理来 j-  ̄- 推导 , 结果 是相 同 的。K la 其 ann滤波 的递推公 式 r
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
其中 S (k ) 是 v (k ) 的协方差矩阵,由于 v (k ) 是零均值高斯随机变量,所以 δ (k ) 服从 nz (nz 是测 量的维数) 个自由度的 χ2 分布,µ(k ) 亦服从 χ2 分布,且
k→∞
lim E [µ(k )] = nz /(1 − α).
588
工
程
数
学
学
报
第26卷
ˆ x ¨m (k − ∆/k − ∆) = 2[z (k − ∆) − z ˆ(k − ∆/k − ∆ − 1)]/T 2 , ˆ ˆ x ˙ m (k − ∆/k − ∆) = x ˙ (k − ∆ − 1/k − ∆ − 1) + T · x ¨m (k − ∆/k − ∆), ˆ x ¨m (k − ∆/k − ∆) = z (k − ∆). 协方差矩阵修正为 pm 11 (k − ∆/k − ∆) = R11 , pm 12 (k − ∆/k − ∆) = 2R11 /T,
第26卷 第4期 2009年08月
工
程
数
学
学
报
CHINESE JOURNAL OF ENGINEERING MATHEMATICS
Vol. 26 No. 4 Aug. 2009
文章编号:1005-3085(2009)04-0586-07
基于变维滤波算法的 Kalman 最佳平滑器 在滑坡监测数据处理中的应用
(16)
+8p12 (k − ∆ − 1/k − ∆ − 1)/T 3 +4p22 (k − ∆ − 1/k − ∆ − 1)/T 2 . 这样,由式 (2)-(17) 便构成了对滑坡自动跟踪的自适应变维滤波算法。 (17)
第4期
唐春艳,彭继兵:基于变维滤波算法的 Kalman 最佳平滑器在滑坡监测数据处理中的应用
关键词: Kalman 最佳平滑器;变维滤波;滑坡;数据处理 分类号: AMS(2000) 62M20
1
引言
滑坡是一个复杂的地质现象,且易受到各种诸如外界环境、人为误差、监测方法的不妥等 因素影响,所以必须对所获得的滑坡监测数据进行预处理,降低数据中的噪声和伪信息的影 响,以提高滑坡预报的精度。 滑坡的发展变化过程一般经历缓慢变形—匀速变形—加速变形—急剧变形四个阶段, 将 Kalman 滤波理论应用于滑坡变形监测的数据处理,传统方法是建立一个固定的状态方 程和观测方程来描述滑坡变形,并用标准 Kalman 滤波对滑坡位移监测数据进行跟踪滤波 去噪[1-3] 。该方法针对滑坡在匀速变形阶段是有效的,但当滑坡进入加速变形阶段时,标 准 Kalman 滤波可能会出现发散,所以需要采用自适应方法。 本文作者曾提出了基于交互多模算法的 Kalman 平滑器处理监测数据[4] ,虽然该方法能较好 处理滑坡监测数据,但是该方法使用的 Markov 链的转移概率矩阵不容易确定。 为此,经过进一步的研究,本文首次将变维滤波 (VD) 算法引入到滑坡监测数据处理中来, 为了提高滑坡预报精度并在此基础上给出了一种 Kalman 滤波平滑算法,该方法简洁明了,而 且也为寻找滑坡形变的变点提供了新的思路。
k
µa (k ) =
j =k−∆−1
δa (j ),
−1
(7) a ˆ(j/j ). (8)
m δa (j ) = a ˆT (j/j ) Pa (j/j )
m a ˆ(j/j ) 为加速度的估计值,Pa (j/j ) 为协方差矩阵的对应块,如果 µa (k ) < Ta ,则加速度估计 无显著性意义,滤波器退出机动模型,其中 Ta 的意义与 Th 相同。 3.2 滤波器初始化 当机动检测器在第 k 时刻检测到机动时,则滤波器假定在 k − ∆ − 1 开始有一恒定的加速, 在窗口 ∆ 内的状态估计应修正如下。
Z (k ) 为滑坡在匀速变形阶段的位置,H = [ 1 0 ],V (k ) 为零均值、方差为 σ 2 的 Gauss 白噪声 序列,且与 W (k ) 不相关。 当滑坡进入加速和急剧加速变形的机动阶段,将加速度作为状态变量的一个分量,并视为 恒定的,将滑坡的地质本身和外界环境等因素引起的直线轨迹的偏离视为加速度的扰动,便可 建立滑坡在加速变形阶段的状态方程 X m (k + 1) = Φm X m (k ) + Γm W m (k ). 其中, m Xm = x ˙ x ¨m xm , Φm = 0 0 1 T 1 0 T 2 /2 T 1 , Γ = T /2 1 T 2 /4 , (4)
式 (23)-(25) 中 j = N − 1, N − 2, · · · , 0。这三式便构成了一套最佳固定区间平滑的逆向递推算 ˆ (N | N ) 和 P (N | N ),可由式 (18)-(22) 给出。 法,初值为 X
5
基 于 变 维 滤波 算 法 的 Kalman 最佳 平 滑 器
由 3.1 介绍的机动检测可知,通过机动监测器能够检测到滑坡进入机动的开始点和结束点, 也能够检测到非机动的开始点和结束点。这样便可在相应的机动区间和非机动区间分别进 行 Kalman 最佳固定区间平滑,最终获得滑坡在整个观测区间上的平滑值。具体算法步骤为: 1) 假定滑坡开始处于匀速变形阶段,故令非机动第一个开始点为 1,滤波器采用非机动模 型跟踪滑坡; 2) 在非机动阶段利用机动监测器检测机动,若在 k 时刻检测到机动,则立即对机动模型 进行初始化,并采用机动模型跟踪滑坡,相应地记下非机动第一个结束点 k ,机动第一个开始 点 k + 1,下转到 4); 3) 若机动监测器在 k 时刻没有检测到机动,则继续利用非机动模型跟踪滑坡,上转 到 2); 4) 在机动阶段利用机动监测器检测非机动,若在 k 时刻检测到非机动,则立即对非机动 模型进行初始化,并采用非机动模型跟踪滑坡,相应地记下机动第一个结束点 k ,非机动第二 个开始点 k + 1,上转到 2); 5) 若机动监测器在 k 时刻没有检测到非机动,则继续利用机动模型跟踪滑坡,上转 到 4); 6) 重复 2)-5),直到 k = M ,M 为观测数据长度; 7) 分别在相应的非机动和机动阶段利用 Kalman 最佳固定区间平滑器对其进行平滑处理。
589
3.3 标准 Kalman 滤波算法 在相应的机动和非机动阶段利用标准 Kalman 滤波算法进行滤波计算,具体算法公式如下 ˆ (k/k − 1) = ΦX ˆ (k − 1/k − 1), X P (k/k − 1) = ΦP (k − 1/k − 1)ΦT + ΓQΓT , K (k ) = P (k/k − 1)H T HP (k/k − 1)H T + R
2
目标模型
滑坡在开始非机动阶段经历的缓慢变形和匀速变形运动可用下面的差分方程描述。 1 x(k + 1) = x(k ) + T x ˙ (k ) + a(k )T 2 , 2 x ˙ (k + 1) = x ˙ (k ) + T a ˙ (k ).
收稿日期: 2007-09-19. 作者简介: 唐春艳 (1979年4月生),女,硕士,讲师. 研究方向:数学与计算机模拟.
唐春艳1 , 彭继兵2
(1- 吉林大学珠海学院公共基础教研中心数学教研室,珠海 519041; 2- 成都理工大学信息管理学院,成都 610059) 摘 要: 本文研究如何对滑坡监测数据进行去噪。利用变维滤波算法能够很好描述滑坡变形的特性,建立 了滑坡运动的数学模型,并引入变维滤波对滑坡监测数据进行降噪。为了提高滑坡预报精度, 提出了一种基于变维滤波的 Kalman 最佳平滑算法。实例仿真结果表明利用该方法不仅预报精度 高,而且也为寻找滑坡监测数据中的变点提供了新的思路。 中图分类号: P642.22 文献标识码: A
(1)
第4期
唐春艳,彭继兵:基于变维滤波算法的 Kalman 最佳平滑器在滑坡监测数据处理中的应用
587
其中,x(k ) 和 x ˙ (k ) 分别表示滑坡在 k 时刻的位置和速度,a(k ) 表示滑坡在 k 到 k + 1 时刻由于 降雨等外界因素引起的加速度,它考虑了滑坡地质本身和外界环境扰动所造成的不可预测行 2 为。由于滑坡处于匀速变形的非机动阶段,故可设 a(k ) 是服从零均值、方差为 σa 的正态分布 2 平稳随机序列,且 a(k ) 和 a(l)(k = l) 互不相关,即 E {a(k )} = 0、E {a(k )a(l)} = σa δ (k − l), 其中, 1, k = 0 δ (k ) = . 0, k = 0 由以上分析可建立滑坡在匀速变形非机动阶段的状态方程和观测方程 X (k + 1) = ΦX (k ) + ΓW (k ), X (k ) = x(k ) x ˙ (k ) , Z (k ) = HX (k ) + V (k ), 1 T T 2 /2 , Γ = , Φ= 0 T T (2) (3) W (k ) = a(k ),
取 ∆ = (1 − α)−1 作为检测机动的有效窗口长度,则机动检测方法为:如果 µ(k ) Th ,则认为 目标在 k − ∆ − 1 时开始有一恒定的加速度加入,这时目标模型应由低阶非机动模型转向高阶 机动模型,其式中 Th 为 nz 个自由度的 χ2 分布对应于给定置信区间的置信度。 由高阶机动模型退回到低阶非机动模型的检测方法是检验加速度估计值是否有统计显著性 意义。令
−1
(18) (19) , (20) (21) (22)
ˆ (k/k ) = X ˆ (k/k − 1) + K (k ) Z (k ) − H X ˆ (k/k − 1) , X P (k/k ) = I − K (k )H P (k/k − 1).
4
Kalman 最 佳 平 滑器
最佳平滑问题分为三种情况:最佳固定区间平滑、最佳固定点平滑、最佳固定滞后平 滑[5-6] ,本文主要采用最佳固定区间平滑,它对应的算法公式如下 ˆ (j | N ) = X ˆ (j | j ) + K (j ) X ˆ (j + 1 | N ) − ΦX ˆ (j | j ) , X K (j ) = P (j | j )ΦT P T (j + 1 | j ), P (j/N ) = P (j/j ) − K (j ) P (j + 1 | j ) − P (j + 1 | N ) K T (j ). (23) (24) (25)