无迹卡尔曼滤波(UKF)

无迹卡尔曼滤波算法用于解决系统方程非线性的情况。无迹卡尔曼滤波算法采用无迹变换对状态值进行采样,采样2n+1个sigma点用于计算均值与协方差。相比于EKF对系统方程线性化,无迹卡尔曼滤波近似程度更高。

  • 系统方程:

状态预测:

观测量计算:

状态更新:

  • 过程推导:​​​​​​​

​​​​​​​无迹变换:一般用离散采样点恢复一种分布,采样点越多,近似度越高,但计算量也越大,比如蒙特卡洛算法。无迹变换利用2n+1个sigma采样点计算均值与协方差,近似原分布,同时计算量较小。

无迹变换需要满足权值之和为1,均值与协方差加权计算如下公式:

权值和状态计算如下:

权重相关参数计算如下式:

​​​​​​​

然后计算高斯得到步骤4、5,得到状态的预测值与预测协方差值。利用预测值与预测协方差值计算观测量的计算值与观测量的协方差值得到6-10。

滤波增益类比EKF计算如下:

  • 4
    点赞
  • 40
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值