lio-sam之FeatureExtraction.cpp

该cpp里就一个回调函数

laserCloudInfoHandler

订阅lio_sam/deskew/cloud_info 去畸变点云

  1. calculateSmoothness
    计算每个点云相邻的5个点深度值的残差和,残差和的平方为该点曲率
  2. markOcclodedPoints
    判断遮挡点和平行点,这两种点都不做特征提取
  3. extractFeatures
    遍历每个扫描线,将每个扫描线分为6段,点云按照曲率大小排序,从大到小遍历,曲率大于阈值为角点,每段取20个角点,选取的角点前后5个点不再处理。从小到大遍历,曲率小于阈值认为是平面点,标记的平面点前后5个点不再处理,平面点和不处理的点,都归为平面点。
    平面点降采样加入平面点云集合。
  4. publishFeatureCloud
    发布topic:
    lio_sam/feature/cloud_corner (rviz发布)
    lio_sam/feature/cloud_surface(rviz发布)
    lio_sam/feature/cloud_info
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值