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

news2025/1/18 11:07:53

函数模型
{ 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.coloradmin.cn/o/619637.html

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈,一经查实,立即删除!

相关文章

C语言:使用 普通方法 和 二分查找算法(折半查找算法) 在一个有序数组中查找具体的某个数字n

题目: 从键盘输入数字n,在一个 有序数组 中查找具体的某个数字n。 思路一:普通方法 (逻辑简单,在无序数组中也可以使用,但效率较低,需要逐个查找) 总体思路: &#xff…

日常培训管理-参训名单/BootstrapTable获取表数据 / js 删除两个数组中id相同的对象/

---2022.11.9 1、 现在有一个功能是从下面待选名单中选中,再点击这个添加按钮,就会将这些人添加到上面这个参训名单,然后再给其中每个人手动打分。分打完 BootstrapTable中有两组数据,在下面待选名单数据条目前面中打钩选中&am…

从零开始学习CTF——CTF基本概念

这一系列把自己学习的CTF的过程详细写出来,方便大家学习时可以参考。 一、CTF简介 01」简介 中文一般译作夺旗赛(对大部分新手也可以叫签到赛),在网络安全领域中指的是网络安全技术人员之间进行技术竞技的一种比赛形式。 CTF…

odoo-028 odoo前端页面显示跟后台数据库内容不一致

文章目录 一、问题二、排查三、总结 版本:odoo13 一、问题 同步多端数据的时候发现,产品product.template页面显示的内容跟用接口查询出来的不一样,接口查询的结果中name值总是后面多一些数据。 页面显示:六甲基二硅胺锂 1.0M T…

开源且免费:全面评估排名前五的缺陷管理工具

软件缺陷管理是一个关于发现,记录,追踪,处理和报告软件缺陷的过程。这是软件开发过程中的一个重要环节,它可以帮助开发团队保持代码的质量并及时修复问题。 一、早期小团队使用的免费缺陷管理工具 在项目早期或者团队规模较小的…

kafka事务(伪事务)

事务要点知识 Kafka的事务控制原理 主要原理: 开始事务-->发送一个ControlBatch消息(事务开始) 提交事务-->发送一个ControlBatch消息(事务提交) 放弃事务-->发送一个ControlBatch消息(事务终…

瓦坎达的科技真的很厉害吗

就漫威电影宇宙来说,瓦坎达的科技真的很厉害吗 厉不厉害我不敢保证,但是这个IP段的服务器是真的好用 43.241.19.1 43.241.19.2 43.241.19.3 43.241.19.4 43.241.19.5 43.241.19.6 43.241.19.7 43.241.19.8 43.241.19.9 43.241.19.10 43.241.19.11 43.2…

使用ETLCloud强大的自定义规则实现自定义数据处理算法

实时数据处理规则有什么作用? 在大数据中的实时数据采集、ETL批量数据传输过程中很多数据处理过程以及数据质量都希望实时进行处理和检测并把不符合要求的脏数据过滤掉或者进行实时的数据质量告警等。 在数据仓库建设过程中,每家企业的数据处理过程中肯…

Java调用Groovy动态加载接口实现类,热部署不需要编译

pom <dependency><groupId>org.codehaus.groovy</groupId><artifactId>groovy-all</artifactId><version>2.4.3</version></dependency> Java接口&#xff1a; public interface Run {public void speed(int s); } Groovy实…

基于SSM的图书馆借阅管理系统

✌全网粉丝20W,csdn特邀作者、博客专家、CSDN新星计划导师、java领域优质创作者,博客之星、掘金/华为云/阿里云/InfoQ等平台优质作者、专注于Java技术领域和毕业项目实战✌ &#x1f345;文末获取项目下载方式&#x1f345; 一、项目背景介绍&#xff1a; 随着社会的发展和信息…

十二、Docker日志管理

Docker日志管理 Docker的日志大致有两种&#xff0c;一是Docker 引擎日志&#xff0c;也就是 dockerd服务自身运行时的日志&#xff1b;二是容器内的服务产生的日志。后一种有一定使用经验的童鞋应该发现有时候我们能通过docker logs查看容器日志&#xff0c;有时候又不能&…

就这水平也去大厂面试?你是怎么敢的啊

面试一直都是一个热门话题&#xff0c;软件测试员当然也逃不过~纵使你是一个技能全部满点的超优秀软件测试员&#xff0c;卡在面试这一关也是万万不可的。特别是大厂的测试员&#xff0c;他们面试所问的东西&#xff0c;你在学校通常接触不道&#xff0c;所以没有哪个应届生是一…

国内元宇宙游戏陆续开放,将带来科技娱乐新鲜感

自元宇宙概念兴起至今&#xff0c;国内多家互联网厂商纷纷参与其中&#xff0c;除了在区块链、人工智能、图像处理、云计算等专业技术领域深入布局&#xff0c;也通过大范围投资或收购的方式来扩大自身的元宇宙游戏版图。围绕这一新兴概念&#xff0c;一场产、学、研的实践正在…

高效科研工具(三):高效检索阅读paper-arXiv网站(arXiv使用大全、掌握研究热点、前沿动态)

高效科研工具&#xff08;三&#xff09;&#xff1a;高效检索阅读paper-arXiv网站&#xff08;arXiv使用大全、掌握研究热点、前沿动态&#xff09; 目录 0、前言&#x1f60f; 1、arXiv网站介绍&#x1f9d0; 2、arXiv网站使用&#x1f60e;&#x1f60e; 3、arXiv网站使用…

语义分割结果可视化(原图+语义掩码+图例)

语义分割结果可视化&#xff08;原图语义掩码图例&#xff09; 由于实习工作需要把语义分割结果可视化出来&#xff0c;要使用自定义颜色来区分不同的label&#xff0c;并绘制出图例并插入在图像右端。本文将介绍如何实现这样的语义分割结果图。 文章目录 语义分割结果可视化&a…

Mysql执行计划怎么看

执行计划就是sql的执行查询的顺序&#xff0c;以及如何使用索引查询&#xff0c;返回的结果集的行数 EXPLAIN SELECT * from A where X? and Y? 1.id :是一个有顺序的编号&#xff0c;是查询的顺序号&#xff0c;有几个 select 就显示几行。id的顺序是按 select 出现的顺序增…

13 【代理配置 插槽】

1.Vue脚手架配置代理 本案例需要下载axios库npm install axios 配置参考文档 Vue-Cli devServer.proxy vue.config.js 是一个可选的配置文件&#xff0c;如果项目的 (和 package.json 同级的) 根目录中存在这个文件&#xff0c;那么它会被 vue/cli-service自动加载。你也可以…

老人跌倒检测识别预警算法 yolov7

老人跌倒检测识别预警系统采用yolov7网络模型技术&#xff0c;老人跌倒检测识别预警算法对老人的行为进行实时监测。当老人发生跌倒时&#xff0c;系统将自动发出警报&#xff0c;及时通知现场护理人员进行处理。YOLOv7 的发展方向与当前主流的实时目标检测器不同&#xff0c;研…

MySQL表操作:提高数据处理效率的秘诀(进阶)(1)

&#x1f495;**“生命不在于相信奇迹&#xff0c;而在于创造奇迹。”——朱学恒**&#x1f495; &#x1f43c;作者&#xff1a;不能再留遗憾了&#x1f43c; &#x1f386;专栏&#xff1a;MySQL学习&#x1f386; &#x1f697;本文章主要内容&#xff1a;MySQL对表操作进阶…

Node.js从基础到项目实践

摘要&#xff1a; Node.js是一个基于Chrome V8引擎的JavaScript运行时环境&#xff0c;它允许开发者使用JavaScript构建高性能的服务器端应用程序。本文将介绍Node.js的基础知识&#xff0c;并通过项目实践的方式帮助读者深入理解Node.js的用法和功能。从基础到项目实践&#x…