[发明专利]激光雷达与深度相机的数据融合方法及系统

摘要

本发明提供了激光雷达与深度相机的数据融合方法及系统，涉及数据融合技术领域，包括通过激光雷达获取激光点，根据激光点获取第一组极坐标串；通过深度相机获取深度图像，其中，深度图像包括第一像素点；根据第一像素点计算第一像素点到激光雷达的第一角度；读取第一像素点的深度信息，并根据深度信息得到每列第一像素点到激光雷达的第一距离；将第一距离和第一角度组成点的集合，从而获取第二组极坐标串；将第一组极坐标串和第二组极坐标串按角度进行序列融合。本发明通过数据融合可以扩大探测范围和提高信息精度。

主权项

1.一种激光雷达与深度相机的数据融合方法，其特征在于，包括：通过激光雷达获取激光点，根据所述激光点获取第一组极坐标串；通过深度相机获取深度图像，其中，所述深度图像包括第一像素点；根据所述第一像素点计算所述第一像素点到所述激光雷达的第一角度；读取所述第一像素点的深度信息，并根据所述深度信息得到每列所述第一像素点到所述激光雷达的第一距离；将所述第一距离和所述第一角度组成点的集合，从而获取第二组极坐标串；将所述第一组极坐标串和所述第二组极坐标串按角度进行序列融合；所述激光雷达为单线激光雷达或多线激光雷达，所述根据所述激光点获取第一组极坐标串包括：当所述激光雷达为所述单线激光雷达时，根据所述激光点直接获取所述第一组极坐标串；当所述激光雷达为所述多线激光雷达时，采用三角函数法将所述激光点投影到水平面；在预设的角度范围内选取第一激光点，并记录所述第一激光点对应的第二距离和第二角度；根据所述第二距离和第二角度组成的点的集合，获取所述第一组极坐标串；所述根据所述第一像素点计算所述第一像素点到所述激光雷达的第一角度包括：获取点密度，根据所述点密度对所述第一像素点按列进行抽样得到第二像素点；从所述第二像素点中剔除深度误差超过误差阈值的像素点得到第三像素点；计算每列的所述第三像素点到所述激光雷达的所述第一角度；所述根据所述深度信息得到每列所述第一像素点到所述激光雷达的第一距离包括：通过比例换算得到所述第一像素点到所述深度相机传感器的实际距离；根据所述实际距离获得每列所述第一像素点到所述激光雷达的所述第一距离。