卡尔曼滤波与组合导航原理(八)遗忘滤波

news/2025/1/1 7:48:36/

函数模型
{ X k = Φ k l k − 1 X k − 1 + Γ k − 1 W k − 1 Z k = H k X k + V k \left\{\begin{array}{l} \boldsymbol{X}_{k}=\boldsymbol{\Phi}_{k l k-1} \boldsymbol{X}_{k-1}+\boldsymbol{\Gamma}_{k-1} \boldsymbol{W}_{k-1} \\ \boldsymbol{Z}_{k}=\boldsymbol{H}_{k} \boldsymbol{X}_{k}+\boldsymbol{V}_{k} \end{array}\right. {Xk=Φklk1Xk1+Γk1Wk1Zk=HkXk+Vk
随机模型
{ E [ W k ] = 0 , E [ W k W j T ] = s N − k + 1 Q k δ k j j , k ≤ N E [ V k ] = 0 , E [ V k V j T ] = s N − k R k δ k j E [ W k V j T ] = 0 \left\{\begin{array}{ll}\mathrm{E}\left[\boldsymbol{W}_{k}\right]=\mathbf{0}, & \mathrm{E}\left[\boldsymbol{W}_{k} \boldsymbol{W}_{j}^{\mathrm{T}}\right]={\color{green}s^{N-k+1}}\boldsymbol{Q}_{k} \delta_{k j}\quad j,k \le N\\ \mathrm{E}\left[\boldsymbol{V}_{k}\right]=\mathbf{0}, & \mathrm{E}\left[\boldsymbol{V}_{k} \boldsymbol{V}_{j}^{\mathrm{T}}\right]={\color{green}s^{N-k}} \boldsymbol{R}_{k} \delta_{k j} \quad \\ \mathrm{E}\left[\boldsymbol{W}_{k} \boldsymbol{V}_{j}^{\mathrm{T}}\right]=\mathbf{0}\end{array}\right. E[Wk]=0,E[Vk]=0,E[WkVjT]=0E[WkWjT]=sNk+1Qkδkjj,kNE[VkVjT]=sNkRkδkj
其中:渐消因子 s ≥ 1 s \ge 1 s1,等于 1 1 1 时与普通的Kalman滤波相同。现在是 N N N 时刻, k k k 越小就是越以前, s N − k s^{N-k} sNk 越大,噪声前面乘的系数就越大,越以前的量测和系统越不可靠,慢慢遗忘; k = N k = N k=N 就是现在,此时 s N − k s^{N-k} sNk 1 1 1

加了 s s s 之后模型还是满足Kalman滤波条件,噪声还是高斯白噪声,只是时变了,在 N N N 时刻的Kalman滤波如下,其实就是多了 s s s
{ X ^ k / k − 1 N = Φ k / k − 1 X ^ k − 1 N P k / k − 1 N = Φ k / k − 1 P k − 1 N Φ k / k − 1 T + Γ k − 1 s N − k Q k − 1 Γ k − 1 T K k N = P k / k − 1 N H k T ( H k P k / k − 1 N H k T + s N − k R k ) − 1 X ^ k N = X ^ k / k − 1 N + K k N ( Z k − H k X ^ k / k − 1 N ) P k N = ( I − K k N H k ) P k / k − 1 N \left\{\begin{array}{l}\hat{\boldsymbol{X}}_{k / k-1}^{N}=\boldsymbol{\Phi}_{k / k-1} \hat{\boldsymbol{X}}_{k-1}^{N} \\ \boldsymbol{P}_{k / k-1}^{N}=\boldsymbol{\Phi}_{k / k-1} \boldsymbol{P}_{k-1}^{N} \boldsymbol{\Phi}_{k / k-1}^{\mathrm{T}}+\boldsymbol{\Gamma}_{k-1} {\color{green}s^{N-k}}\boldsymbol{Q}_{k-1} \boldsymbol{\Gamma}_{k-1}^{\mathrm{T}} \\ \boldsymbol{K}_{k}^{N}=\boldsymbol{P}_{k / k-1}^{N} \boldsymbol{H}_{k}^{\mathrm{T}}\left(\boldsymbol{H}_{k} \boldsymbol{P}_{k / k-1}^{N} \boldsymbol{H}_{k}^{\mathrm{T}}+{\color{green}s^{N-k}} \boldsymbol{R}_{k}\right)^{-1} \\ \hat{\boldsymbol{X}}_{k}^{N}=\hat{\boldsymbol{X}}_{k / k-1}^{N}+\boldsymbol{K}_{k}^{N}\left(\boldsymbol{Z}_{k}-\boldsymbol{H}_{k} \hat{\boldsymbol{X}}_{k / k-1}^{N}\right) \\ \boldsymbol{P}_{k}^{N}=\left(\boldsymbol{I}-\boldsymbol{K}_{k}^{N} \boldsymbol{H}_{k}\right) \boldsymbol{P}_{k / k-1}^{N}\end{array}\right. X^k/k1N=Φk/k1X^k1NPk/k1N=Φk/k1Pk1NΦk/k1T+Γk1sNkQk1Γk1TKkN=Pk/k1NHkT(HkPk/k1NHkT+sNkRk)1X^kN=X^k/k1N+KkN(ZkHkX^k/k1N)PkN=(IKkNHk)Pk/k1N
增益计算回路改写

提取出 s N k s^{N_k} sNk
s − ( N − k ) P k / k − 1 N = Φ k / k − 1 s ⋅ s − [ N − ( k − 1 ) ] P k − 1 N Φ k / k − 1 T + Γ k − 1 Q k − 1 Γ k − 1 T K k N = s − ( N − k ) P k ∣ k − 1 N H k T ( H k s − ( N − k ) P k k k − 1 N H k T + R k ) − 1 s − ( N − k ) P k N = ( I − K k N H k ) s − ( N − k ) P k ∣ k − 1 N \begin{array}{l} {\color{red}s^{-(N-k)} \boldsymbol{P}_{k / k-1}^{N}}=\boldsymbol{\Phi}_{k / k-1} {\color{green}s} \cdot {\color{red}s^{-[N-(k-1)]} \boldsymbol{P}_{k-1}^{N}} \boldsymbol{\Phi}_{k / k-1}^{\mathrm{T}}+\boldsymbol{\Gamma}_{k-1} \boldsymbol{Q}_{k-1} \boldsymbol{\Gamma}_{k-1}^{\mathrm{T}} \\ \boldsymbol{K}_{k}^{N}={\color{red}s^{-(N-k)} \boldsymbol{P}_{k \mid k-1}^{N}}\boldsymbol{H}_{k}^{\mathrm{T}}\left(\boldsymbol{H}_{k} {\color{red}s^{-(N-k)} \boldsymbol{P}_{k k k-1}^{N}} \boldsymbol{H}_{k}^{\mathrm{T}}+\boldsymbol{R}_{k}\right)^{-1} \\ {\color{red}{s^{-(N-k)} \boldsymbol{P}_{k}^{N}}}=\left(\boldsymbol{I}-\boldsymbol{K}_{k}^{N} \boldsymbol{H}_{k}\right) s^{-(N-k)} \boldsymbol{P}_{k \mid k-1}^{N} \\ \end{array} s(Nk)Pk/k1N=Φk/k1ss[N(k1)]Pk1NΦk/k1T+Γk1Qk1Γk1TKkN=s(Nk)Pkk1NHkT(Hks(Nk)Pkkk1NHkT+Rk)1s(Nk)PkN=(IKkNHk)s(Nk)Pkk1N
将红色部分合并:令 P k ∗ ≜ s − ( N − k ) P k N , P k / k − 1 ∗ ≜ s − ( N − k ) P k / k − 1 N \boldsymbol{P}_{k}^{*} \triangleq s^{-(N-k)} \boldsymbol{P}_{k}^{N}, \boldsymbol{P}_{k / k-1}^{*} \triangleq s^{-(N-k)} \boldsymbol{P}_{k / k-1}^{N} Pks(Nk)PkN,Pk/k1s(Nk)Pk/k1N ,得
{ X ^ k / k − 1 ∗ = Φ k / k − 1 X ^ k − 1 ∗ P k / k − 1 ∗ = Φ k / k − 1 ( s P k − 1 ∗ ) Φ k / k − 1 T + Γ k − 1 Q k − 1 Γ k − 1 T K k ∗ = P k / k − 1 ∗ H k T ( H k P k / k − 1 ∗ H k T + R k ) − 1 X ^ k ∗ = X ^ k / k − 1 ∗ + K k ∗ ( Z k − H k X ^ k / k − 1 ∗ ) P k ∗ = ( I − K k ∗ H k ) P k / k − 1 ∗ \left\{\begin{array}{l}\hat{\boldsymbol{X}}_{k / k-1}^{*}=\boldsymbol{\Phi}_{k / k-1} \hat{\boldsymbol{X}}_{k-1}^{*} \\ \boldsymbol{P}_{k / k-1}^{*}=\boldsymbol{\Phi}_{k / k-1}\left({\color{green}s} \boldsymbol{P}_{k-1}^{*}\right) \boldsymbol{\Phi}_{k / k-1}^{\mathrm{T}}+\boldsymbol{\Gamma}_{k-1} \boldsymbol{Q}_{k-1} \boldsymbol{\Gamma}_{k-1}^{\mathrm{T}} \\ \boldsymbol{K}_{k}^{*}=\boldsymbol{P}_{k / k-1}^{*} \boldsymbol{H}_{k}^{\mathrm{T}}\left(\boldsymbol{H}_{k} \boldsymbol{P}_{k / k-1}^{*} \boldsymbol{H}_{k}^{\mathrm{T}}+\boldsymbol{R}_{k}\right)^{-1} \\ \hat{\boldsymbol{X}}_{k}^{*}=\hat{\boldsymbol{X}}_{k / k-1}^{*}+\boldsymbol{K}_{k}^{*}\left(\boldsymbol{Z}_{k}-\boldsymbol{H}_{k} \hat{\boldsymbol{X}}_{k / k-1}^{*}\right) \\ \boldsymbol{P}_{k}^{*}=\left(\boldsymbol{I}-\boldsymbol{K}_{k}^{*} \boldsymbol{H}_{k}\right) \boldsymbol{P}_{k / k-1}^{*}\end{array}\right. X^k/k1=Φk/k1X^k1Pk/k1=Φk/k1(sPk1)Φk/k1T+Γk1Qk1Γk1TKk=Pk/k1HkT(HkPk/k1HkT+Rk)1X^k=X^k/k1+Kk(ZkHkX^k/k1)Pk=(IKkHk)Pk/k1
改写的式子中就只有一个 s s s ,用起来很简单,对上一时刻的 P P P 阵乘以一个标量 s s s 就行。

遗忘效果的理解

s s s 取值越大,对以前信息的利用更小

在这里插入图片描述


http://www.ppmy.cn/news/260790.html

相关文章

嵌入式Linux应用程序开发——期末复习重点

目录 前言 题型分布第1章 搭建嵌入式Linux开发环境1.1 构建嵌入式linux交叉开发环境1.2 Bootloader 第2章 Linux系统调用及用户编程接口(API)2.1.2 用户编程接口(API)2.2 Linux 文件I/O系统概述2.3 底层文件…

TUIO+激光投影互动

一款全新的触屏互动方式,把红外灯光覆盖到规则物体的表面, 通过红外摄像头捕捉此区域的红外光的变化经数字处理后,转换为 WIDNWOS的鼠标位移轨迹,从而实现视频、动画、游戏 的效果互动。 由红外摄像捕捉到参与者的肢体动作将图像传…

地面互动投影解决方案

地面互动投影是一种很受欢迎的投影技术,简单来说就是参与者和地面上影像的真实互动,使多名参与者融入场景中,同时参与游戏。 地面互动投影有水波纹、翻转、碰撞、擦除、避让、跟随等多种表现形式。 互动投影系统通过观众的身体动作来与图像…

全息投影是计算机技术吗,全息互动投影是什么?有什么特别优势?

原标题:全息互动投影是什么?有什么特别优势? 说起全息投影,可能很多朋友对此有了解,这是一种记录并且再现物体三维信息的展示方式,而互动投影则是一种通过计算机视觉技术以及多媒体投影显示技术&#xff0c…

【展馆设计】互动多媒体投影有哪些实用价值

互动投影技术是当今展厅设计中流行且常见的多媒体互动技术,与传统投影相比,互动投影最大的特点是游客在观看投影的同时,可以与投影中的图片有很强的互动体验。 一、互动投影,以其新颖的投影方式和极大的观赏价值,可以充…

球幕互动投影

之前课余时间开发的一个球幕互动的演示平台,拿出来和大家分享。 源码下载地址: https://github.com/vic-w/MyUniverse 先看看具体的效果: http://v.youku.com/v_show/id_XMzM3ODEyMjMy.html 这个互动软件是需要投影仪从球幕下方将图像投影到球…

沉浸式互动投影

记录下最近制作的互动投影项目~ 这个项目好多坑,为了避免下次入坑,所以做个记录。 首先说一下设备,总共是八个投影,墙面一共是4个,地面是4个。墙面又分为左中右屏。最终完成的项目墙面和地面是要可以连接起来的&#…

【论文阅读】dreambooth

简介 目标:subject-driven generation,针对特定物体的图像生成,仅使用少量目标主体图像,dreambooth可以在prompt的指导下生成大量目标主体在不同场景下的图像。例如下图中小狗,我们给定的set就是左侧的input images&a…