基于滤波器的激光SLAM-2-Fast-SLAM

(Mark:有空把Fast-SLAM论文看一下)

原理

Fast-SLAM也是用粒子滤波(RBPF,就是PF加了RB分解,把地图m提出来了)。

之前我们已经推导过贝叶斯滤波即,给定观测和控制量,当前时刻状态量x 等于 

常数 * 观测 *(运动模型 * 上一时刻状态量)

那实际SLAM运用中我们还需要一个地图m,那就是求p(x_1_:_t,m|u_1_:_t,z_1_:_t)

 

(引入条件概率公式)

p(a,b)=p(a)*(b|a)

 

可以得到

p(x_1_:_t,m|u_1_:_t,z_1_:_t)=p(x_1_:_t|u_1_:_t,z_1_:_t)*p(m|x_1_:_t,u_1_:_t,z_1_:_t)

地图m跟控制量无关

p(x_1_:_t,m|u_1_:_t,z_1_:_t)=p(x_1_:_t|u_1_:_t,z_1_:_t)*p(m|x_1_:_t,z_1_:_t)

我们只需要把精力放在求机器人状态上面p(x_1_:_t|u_1_:_t,z_1_:_t)

因为有了状态之后,地图p(m|x_1_:_t,z_1_:_t)是有确定解的(close_form)。

 

跟之前的两篇一样,我们希望把这个状态量做成一个迭代解的形式。(把轨迹问题转变成增量问题)。

推导如下

评论 2
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值