一、功能概述
1、算法概述
该功能使用光束模型,然后使用寻脚算法,在非地面点上检测道路角度。
Beam Model
beam model 步骤如下:
1、从安装在ego车辆上的激光雷达传感器发射一系列光束。激光雷达传感器是发射点。
2、根据传感器的角分辨率将光束划分为光束区。
3、确定相对于发射点的波束角度和波束长度。
4、对于每个波束区,确定离发射点最近的点和离发射点最远的点之间的距离。计算归一化光束长度为最短距离与最长距离之比。
Toe-Finding Algorithm
1、根据规范化光束长度将光束区划分为扇区。
2、使用指定的MinSectorSize
和SectorMergeThreshold
值更新扇区。
2、主要函数
roadAngles = detectRoadAngles(offRoadPointCloud