Chapter7-基于已知位姿的建图方法

Chapter7-基于已知位姿的建图方法



如有错误望不吝赐教!!!



地图分类

尺度地图(栅格地图)
拓扑地图
语义地图

覆盖栅格建图算法

  • 栅格地图的特征点
    把环境分成一个个小栅格
    每个栅格有两种状态:占用、空闲(去除一些小的通行区域)
    非参模型
    随着地图增大,内存暴增
    天然区分可通行区域,适合进行轨迹规划

  • 构建栅格地图
    给定机器人位姿和传感器的观测数据(主要指激光雷达)data={x1,z1,x2,z2,…xn,zn}
    估计出最可能的地图(极大似然估计)

  • 假设
    栅格地图中的栅格是一二元随机变量
    1为占用,0为空闲,0.5表示不知道
    建图过程中,环境不会发生改变
    每一个栅格都是独立的
    地图估计问题=对每个栅格的估计的乘
    估计环境的地图只需要对每一个栅格进行估计即可

  • 地图估计
    我不ok

  • 流程
    算法对某一个栅格进行操作的时候只有加法操作,有很高的更新速度
    更新时需要知道传感器的逆测量模型

  • 激光雷达的逆观测模型
    经过的栅格都为Free
    击中的栅格为Occupied
    其余栅格为Unknow
    先算出来都通过了什么栅格,击中了那些栅格,…

计数建图算法

  • 对每个栅格统计两个量,栅格被激光束通过的次数misses(i),被激光束击中的次数hits(i)
    当hits(i)/[misses(i)+hits(i)]超过阈值则认为栅格为Occupied,否则为Free
    hits(i)/[misses(i)+hits(i)]表示栅格的极大似然估计
  • 地图估计
    地图的极大似然估计的等价、化简
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值