【数学和算法】扩展卡尔曼滤波器(六)

本文是观看B站视频【卡尔曼滤波器】6_扩展卡尔曼滤波器_Extended Kalman Filter所做的截图和笔记。

前面讲的都是线性系统,他们可以用卡尔曼滤波器进行预测。
对于非线性系统,可以将非线性系统线性化,就需要用到扩展卡尔曼滤波器

线性化:泰勒级数 视频

对于泰勒公式的讲解,请跳转参考这篇博客:泰勒公式_线性化

对于一维度的非线性系统进行线性化,就是泰勒一阶展开,对于高维度,就用到了雅各比矩阵
在这里插入图片描述
A就是雅各比矩阵,他是随着时刻k变化的,所以每次都要重新计算。

由于系统有误差,无法在真实点处进行线性化,所以f就在上一时刻k-1时刻的先验估计 x k − 1 − \displaystyle\color{blue}x_{k-1}^- xk1处进行线性化。 z k \displaystyle\color{blue}z_k zk就在 x k ~ \displaystyle\color{blue}\tilde{x_k} xk~处进行线性化。

在这里插入图片描述
在这里插入图片描述
在这里插入图片描述

扩展卡尔曼滤波器的五个公式:
在这里插入图片描述

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值