摘要
本申请公开了一种井下矿自动驾驶中障碍物轮廓计算方法,涉及无人驾驶领域,包括:获取聚类后的障碍物点云数据;根据障碍物点云数据的点数判断是否为噪点;对于非噪点的障碍物点云,通过统计点云数量和对点云均匀降采样,计算AABB包围盒轮廓;根据AABB包围盒轮廓,判断是否满足预设的多边形轮廓计算条件;对计算得到的AABB包围盒轮廓进行旋转和交点计算,通过建立ktree索引查找距离障碍物点云最近的交点并对交点进行排序,得到障碍物的外接多边形轮廓;对外接多边形轮廓进行相邻点之间的夹角计算和点的简化,得到障碍物的最终轮廓。针对现有技术中井下矿自动驾驶过程中障碍物轮廓计算精度低,本申请在保证计算效率的同时提高了轮廓提取的精度。