最全kalman滤波理解三:协方差矩阵的计算_误差协方差矩阵,2024年最新最新C C++高级面试题汇总

img
img

网上学习资料一大堆,但如果学到的知识不成体系,遇到问题时只是浅尝辄止,不再深入研究,那么很难做到真正的技术提升。

需要这份系统化的资料的朋友,可以添加戳这里获取

一个人可以走的很快,但一群人才能走的更远!不论你是正从事IT行业的老鸟或是对IT行业感兴趣的新人,都欢迎加入我们的的圈子(技术交流、学习资源、职场吐槽、大厂内推、面试辅导),让我们一起学习成长!

在使用时协方差矩阵P是一个迭代更新的量,每一轮预测和更新后,P都会更新一个新的值,因此初始化时可以根据估计协定,不用太苛求初始化的精准度,因为随着几轮迭代会越来越趋紧真实值。


(二)过程误差协方差矩阵Q

该矩阵的每一个元素分别是状态X的元素误差之间的协方差,以上文中的状态X为例,其包含位置p和速度v两个元素,其误差状态为:

其Q矩阵可用下式表示:

该矩阵是由不确定的噪声引起的,确定Q的各元素大小是不容易的,使用时都是具体问题具体分析,比方说针对上文中的小车的状态,误差来源是移动中的打滑等,最底层的是由于力的变化导致的加速度的变化,因此我们找到了加速度方差,就可以推导出Q矩阵,假设加速度方差是D(a)。

根据,

得到,

因此,


(三)测量噪声协方差矩阵R

测量噪声协方差的来源是传感器误差,即传感器的不准确性,在使用时一般传感器都会给出精度指标,该指标就可以直接转化到矩阵R中,还以上文小车为例,假设测量矩阵为下式所示:

表示状态X中的位置p和速度v均可以测量,观测误差协方差矩阵R用下式表示:

此时对角线上就是各测量量的测量方差,从传感器说明书上均可以读到,另外针对状态之间的协方差吐过确定不了就可以设为0,即可以如下设置:

img
img

网上学习资料一大堆,但如果学到的知识不成体系,遇到问题时只是浅尝辄止,不再深入研究,那么很难做到真正的技术提升。

需要这份系统化的资料的朋友,可以添加戳这里获取

一个人可以走的很快,但一群人才能走的更远!不论你是正从事IT行业的老鸟或是对IT行业感兴趣的新人,都欢迎加入我们的的圈子(技术交流、学习资源、职场吐槽、大厂内推、面试辅导),让我们一起学习成长!

很快,但一群人才能走的更远!不论你是正从事IT行业的老鸟或是对IT行业感兴趣的新人,都欢迎加入我们的的圈子(技术交流、学习资源、职场吐槽、大厂内推、面试辅导),让我们一起学习成长!**

  • 4
    点赞
  • 7
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
卡尔曼滤波是一种常用的状态估计方法,它通过对系统的状态进行预测和更新,实现对系统状态的估计和控制。在卡尔曼滤波中,协方差矩阵是非常重要的一个参数,它描述了系统状态与观测值之间的关系。 协方差矩阵的设置对卡尔曼滤波的性能有着重要的影响。通常情况下,卡尔曼滤波的初始状态协方差矩阵可以通过经验或者试错的方法进行设置。在实际应用中,一般采用如下步骤进行协方差矩阵的设置: 1. 设置初始状态 根据实际应用需要,设置卡尔曼滤波的初始状态,包括状态向量和状态协方差矩阵。 2. 选择观测噪声 选择观测噪声的分布类型,包括高斯分布、均匀分布等,并设置观测噪声的方差。 3. 计算卡尔曼增益 根据系统的状态转移矩阵和观测矩阵,计算卡尔曼增益。 4. 计算预测协方差矩阵 根据系统状态转移矩阵、控制矩阵、状态噪声协方差矩阵和初始状态协方差矩阵计算预测协方差矩阵。 5. 计算状态更新协方差矩阵 根据卡尔曼增益、观测噪声协方差矩阵和预测协方差矩阵计算状态更新协方差矩阵。 需要注意的是,卡尔曼滤波协方差矩阵设置应该根据实际应用进行调整。如果系统的状态变化比较缓慢,可以适当增大初始状态协方差矩阵;如果系统的状态变化比较快,可以适当减小初始状态协方差矩阵。同时,观测噪声的方差设置也应该根据实际情况进行调整。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值