ROI-cloud: A Key Region Extraction Method for LiDAR Odometry and Localization


  本文基于特征选择点云中的关键区域,仅使用关键区域来进行位姿跟踪和全局定位,在加快了速度的同时,优化了效果。

特征提取

  采用和LOAM相似的特征提取策略,采用启发性阈值代替了对光滑度进行排序。
  在方形区域中,计算特征分布的协方差矩阵。根据协方差矩阵的特征值计算方形区域的重要性。
f = λ 1 e ∑ j ∈ Σ e λ j e ∣ P e ∣ + η λ 1 p + λ 2 p ∑ j ∈ Σ p λ j p ∣ P p ∣ f=\frac{\lambda_{1}^{e}}{\sum_{j \in \Sigma^{e}} \lambda_{j}^{e}}\left|P^{e}\right|+\eta \frac{\lambda_{1}^{p}+\lambda_{2}^{p}}{\sum_{j \in \Sigma^{p}} \lambda_{j}^{p}}\left|P^{p}\right| f=jΣeλjeλ1ePe+ηjΣpλjpλ1p+λ2pPp
  上式考察一个区域内的特征是否具有相似的方向向量或者法向量。

重要性更新

  基于粒子滤波来进行方向区域的重要性更新和机器人位姿估计。使用重要性作为粒子的权重。去除重要性过低和运动不一致的粒子。

其他细节

  • 在激光前方随机生成一些粒子来避免粒子缺乏。
  • 在车辆四个方向分别执行贝叶斯滤波来保证特征的均匀分布和约束的完整性。
  • 抑制粒子过于集中在高重要性的区域中。
  • 使用Monte Carlo方法来进行点云区域的匹配。

实验

  基于ROI对传统激光SLAM进行修正,只在关键区域中执行里程计和全局定位。
  粒子滤波隐式去除动态物体有利于提升算法的精度,只采用关键区域能够有效提升速度。

  • 1
    点赞
  • 1
    收藏
    觉得还不错? 一键收藏
  • 1
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值