本发明专利技术公开了一种剔除点云地图中动态物体点云的方法，车辆正常行驶，采集激光雷达扫描得到的周边环境信息的点云数据，以及组合导航的3D位姿信息；根据激光雷达扫描得到的周边环境信息，识别跟踪动态目标点云的运动并且剔除动态目标；使用地图关键帧的时间维度的数据对地图中残留的动态目标点云簇进行跟踪，同时在动态目标跟踪的目标关联阶段引入点云数量属性。本发明专利技术利用点云帧在时间和空间两个维度上的信息，跟踪动态目标点云的运动，减少对静态目标的误删除。本发明专利技术在使用数据关联跟踪运动目标所在点云的运动时，引入相邻点云帧中目标聚类簇的点的数量的比值作为数据关联时的一个新属性，提升单纯使用激光雷达输出的点云跟踪运动目标的效果。跟踪运动目标的效果。跟踪运动目标的效果。
【技术实现步骤摘要】
一种剔除点云地图中动态物体点云的方法
[0001]本专利技术涉及辅助驾驶技术，尤其涉及一种剔除点云地图中动态物体点云的方法。
技术介绍
[0002]随着近几年来汽车产业的飞速发展，辅助驾驶技术特别是高级辅助驾驶技术成为了各大车企争相抢占的技术制高点。各大车企竞相推出搭载l2+和l2.99级别的辅助驾驶技术的车型。
[0003]目前实现高级辅助驾驶主要面临定位，感知，规划和控制这几个细分领域的技术难题。其中定位技术解决的不仅仅是车辆在哪条路，行驶方向是朝哪个方向的简单问题，还要负责高速高级辅助驾驶系统车辆当前所处的车道以及车辆在车道中的准确横向和纵向位置。
[0004]目前解决定位问题最为普遍的方法是使用先验地图作为参考，结合车辆传感器扫描到的车辆周边的环境信息进行匹配，得出车辆在先验地图中的位置。地图的正确性直接影响到了后期的定位精度，这就要求见图过程中要尽量多的还原静态场景信息，尽可能减少动态物体对地图的影响。
[0005]目前减少动态物体对地图影响的方法主要有以下几种：使用栅格地图过滤动态物体；通过计算占据概率过滤动态物体；通过最近点迭代算法过滤动态物体；还有近几年出现的使用深度学习训练出的模型过滤动态物体。
[0006]区别于以上算法，本专利技术提出一种剔除点云地图中动态物体点云的方法，对地图中的动态目标点云的剔除更彻底，不会误删地图中静态点。
技术实现思路
[0007]为解决现有技术中存在的不足，本专利技术的目的在于，提供一种剔除点云地图中动态物体点云的方法，使用地图关键帧的时间维度的数据对地图中残留的动态目标点云簇进行跟踪，同时在动态目标跟踪的目标关联阶段引入点云数量属性。
[0008]为实现本专利技术的目的，本专利技术所采用的技术方案是：
[0009]一种剔除点云地图中动态物体点云的方法，包括步骤：
[0010](1)车辆正常行驶，数据采集单元同步采集激光雷达扫描得到的周边环境信息的点云数据，以及组合导航的3D位姿信息；
[0011](2)动态目标剔除单元根据激光雷达扫描得到的周边环境信息，识别跟踪动态目标点云的运动并且剔除动态目标；
[0012](3)地图生成单元根据组合导航的3D位姿和剔除动态目标的点云帧生成周围环境的高精度点云地图。
[0013]进一步地，步骤(1)中，同步采集组合导航输出的3D位姿和激光雷达输出的扫描数据，得到组合导航位姿序列Position_queue_rtk和激光雷达扫描数据帧序列Pointcloud_queue_lidar。
[0014]进一步地，步骤(2)中，具体包括步骤：
[0015](2.1)从激光雷达扫描数据帧序列Pointcloud_queue_lidar的第一帧开始，提取连续5帧激光雷达扫描数据到子序列Pointcloud_queue_submap；
[0016](2.2)从子序列Pointcloud_queue_submap的第一帧开始，提取1帧激光雷达扫描数据并且对这帧点云执行非地面点提取算法，得到该帧点云中的非地面点存储到非地面点序列Pointcloud_none_ground；
[0017](2.3)利用组合导航位姿序列Position_queue_rtk和子序列Pointcloud_queue_submap激光雷达扫描数据同步采集的位姿信息，结合组合导航到激光雷达的外参矩阵拼接除了当前点云帧以外的相邻点云帧，得到局部点云地图Submap_lidar；
[0018](2.4)遍历非地面点序列Pointcloud_none_ground中的每一个点，计算这个点在局部点云地图Submap_lidar中的最邻近点，及到最邻近点的距离；存储距离小于阈值的非地面点序列Pointcloud_none_ground中的点到可能运动点簇Pointcloud_moving；
[0019](2.5)在可能运动点簇Pointcloud_moving中执行欧式聚类算法米，删除掉聚类中点的数量小于阈值的聚类簇，得到运动目标聚类簇Cluster_moving[i]；
[0020](2.6)重复步骤2.2到步骤2.5直到子序列Pointcloud_queue_submap中的所有点云都遍历得到运动目标聚类簇Cluster_moving[i]，i的范围0
‑
4；
[0021](2.7)重复步骤2.1到步骤2.6直到激光雷达扫描数据帧序列Pointcloud_queue_lidar中的所有点云都遍历得到运动目标聚类簇Cluster_moving[i]，i的范围0
‑‘
n
‑1’
；
[0022](2.8)从i＝0开始，跟踪运动目标聚类簇Cluster_moving[i]中的动态目标聚类簇的运动轨迹，得到运动目标点云的速度和运动方向；
[0023](2.9)提取步骤2.8中数据关联成功且速度大于阈值的运动目标点云聚类簇到待剔除点云聚类簇Custer_moving_verified[i]；
[0024](2.10)遍历激光雷达扫描数据帧序列Pointcloud_queue_lidar，剔除点云帧Pointcloud_queue_lidar[i]中的动态目标点云聚类簇Custer_moving_verified[i]，得到剔除动态目标点云后的点云帧Pointcloud_queue_lidar_none_moving[i]。
[0025]进一步地，步骤(2.8)中，从i＝0开始取Cluster_moving[i]和Cluster_moving[i+1]，结合Cluster_moving[i]和Cluster_moving[i+1]各自所在点云帧采集时的时间信息，组合导航位姿信息和组合导航到激光雷达的外参矩阵计算出Cluster_moving[i]中的一个运动物体聚类簇运动到Cluster_moving[i+1]中的对应位置的速度和运动方向。
[0026]进一步地，使用数据关联判断Cluster_moving[i]和Cluster_moving[i+1]哪些点云簇是两帧点云簇中的同一个运动目标的点云；该数据关联属性为，聚类簇Cluster_moving[i+1]中的一个运动目标的聚类簇中的点的数量与聚类簇Cluster_moving[i]中的一个运动目标的聚类簇中的点的数量的比值。
[0027]进一步地，步骤(3)中，利用位姿序列Position_queue_rtk和剔除动态目标点云后的点云帧Pointcloud_queue_lidar_none_moving[i]激光雷达扫描数据同步采集的位姿信息，结合组合导航到激光雷达的外参矩阵拼接从i＝0到i＝n
‑
1的相邻点云帧，得到不包含动态目标点云的静态点云地图Map_lidar_static。
[0028]一种剔除点云地图中动态物体点云的系统，包括安装于车辆顶部的激光雷达和组合导航，以及数据采集单元、动态目标剔除单元和地图本文档来自技高网...
【技术保护点】
【技术特征摘要】
1.一种剔除点云地图中动态物体点云的方法，其特征在于，包括步骤：(1)车辆正常行驶，数据采集单元同步采集激光雷达扫描得到的周边环境信息的点云数据，以及组合导航的3D位姿信息；(2)动态目标剔除单元根据激光雷达扫描得到的周边环境信息，识别跟踪动态目标点云的运动并且剔除动态目标；(3)地图生成单元根据组合导航的3D位姿和剔除动态目标的点云帧生成周围环境的高精度点云地图。2.根据权利要求1所述的剔除点云地图中动态物体点云的方法，其特征在于，步骤(1)中，同步采集组合导航输出的3D位姿和激光雷达输出的扫描数据，得到组合导航位姿序列Position_queue_rtk和激光雷达扫描数据帧序列Pointcloud_queue_lidar。3.根据权利要求2所述的剔除点云地图中动态物体点云的方法，其特征在于，步骤(2)中，具体包括步骤：(2.1)从激光雷达扫描数据帧序列Pointcloud_queue_lidar的第一帧开始，提取连续5帧激光雷达扫描数据到子序列Pointcloud_queue_submap；(2.2)从子序列Pointcloud_queue_submap的第一帧开始，提取1帧激光雷达扫描数据并且对这帧点云执行非地面点提取算法，得到该帧点云中的非地面点存储到非地面点序列Pointcloud_none_ground；(2.3)利用组合导航位姿序列Position_queue_rtk和子序列Pointcloud_queue_submap激光雷达扫描数据同步采集的位姿信息，结合组合导航到激光雷达的外参矩阵，拼接除了当前点云帧以外的相邻点云帧，得到局部点云地图Submap_lidar；(2.4)遍历非地面点序列Pointcloud_none_ground中的每一个点，计算这个点在局部点云地图Submap_lidar中的最邻近点，及到最邻近点的距离；存储距离小于阈值的非地面点序列Pointcloud_none_ground中的点到可能运动点簇Pointcloud_moving；(2.5)在可能运动点簇Pointcloud_moving中执行欧式聚类算法米，删除掉聚类中点的数量小于阈值的聚类簇，得到运动目标聚类簇Cluster_moving[i]；(2.6)重复步骤2.2到步骤2.5直到子序列Pointcloud_queue_submap中的所有点云都遍历得到运动目标聚类簇Cluster_moving[i]，i的范围0
‑
4；(2.7)重复步骤2.1到步骤2.6直到激光雷达扫描数据帧序列Pointcloud_queue_lidar中的所有点云都遍历得到运动目标聚类簇Cluster_mov...
【专利技术属性】
技术研发人员：ꢀ七四专利代理机构，
申请(专利权)人：奥特酷智能科技南京有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。