反光柱定位算法实战03:VEnus代码解析和纯反光柱定位中的可改进方向

一、引言:从理念到落地的距离

这一篇结合VEnus的核心代码,展开讲解纯反光柱定位和建图中的每一步实现。同时,VEnus作为一个开源框架必然存在一些有待完善的局限,本文将指出这些局限并探讨可行的改进方向。

二、核心代码流程逐步解构

2.1 强度提取

VEnus的数据处理起始于IntensityExtraction::Extract函数。输入数据是VEnus::Sensor::IntensityRange2D类型的点云,该类型定义在sensor.proto文件中,包含时间戳timestamp、坐标系frame_id以及repeated IntensityPoint2D points字段。IntensityPoint2D进一步包含x、y坐标和强度值intensity三个关键信息。
 

message IntensityPoint2D { 

    float x = 1; 

    float y = 2; 

    float intensity = 3; 

}



Extract函数的核心逻辑是对整个点云进行一次遍历,取连续的n个点(由参数intensity_median_filter_param决定,典型值为3或5)。只要其中有超过一半的点强度超过阈值intensity_threshold(通常设置在200-250之间),就认为该窗口内存在反光柱,将其中强度处于中间值的那个点存入容器candidate_cloud中。

这种强度阈值提取的方式没有问题,

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

SLAM及ROS学习笔记

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值