卡尔曼滤波原理_SLAM -- 具有偏差输入的卡尔曼滤波能观性理解

本文探讨了卡尔曼滤波在处理非线性系统及存在输入偏差情况下的能观性问题。通过分析带有输入误差的卡尔曼滤波模型,解释了如何构建增广矩阵来估计状态和偏差。文章指出,系统可观的条件是增广后的能观性矩阵满秩,这对于确保滤波算法的收敛性和准确性至关重要。
摘要由CSDN通过智能技术生成

45e07e3bb4f286e4ed338dec779c20d2.png

卡尔曼滤波的基本原理可以参考:

ARUANTOU:基础卡尔曼滤波​zhuanlan.zhihu.com
ce075e774327898c1e847e48039e7892.png

我们都知道卡尔曼滤波在噪声和量测噪声为不相关、零期望的白噪声,且是线性系统,初始时刻的状态估计是无偏的条件下,才能保持无偏的特性。而具有无偏特性的卡尔曼滤波算法是有解的,可以计算出最终的定位位置。也称可观的。

要理解可观性,我们需要先看看带有输入误差的卡尔曼滤波。

现实是存在很多非线性的运动,以及未知的测量和运动误差。这样一来传统的线性卡尔曼滤波就显得太过理想了。我们需要调整下它的实现:

假设运动观测模型如下:

预测:

观测:

标记*为后验

现在需要对这个模型考虑误差,先考虑未知的输入偏差U

  • 1
    点赞
  • 1
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值