[发明专利]一种全景环带相机与激光雷达联合标定的方法

说明书

本发明公开了一种全景环带相机与激光雷达联合标定的方法，包括：S1.获取激光雷达的点云数据以及全景环带图像数据；S2.根据全景环带图像数据标定全景环带相机，得到相机参数；S3.提取所有标定板上的点云数据，得到平面方程；S4.计算每块标定板在激光雷达坐标系下的平面方程的法向量，并进行归一化处理；S5.计算每块标定板在全景环带相机坐标系下的法向量，并进行归一化处理；S6.将标定板点云数据法向量和图像数据法向量根据标定结果投影至全景环带图像上，并记录各自编号及像素坐标；S7.基于记录的编号，采用最小二乘法进行拟合，得到拟合后的法向量的像素坐标；S8.计算旋转矩阵与平移矩阵，完成全景环带相机与激光雷达的联合标定。

技术领域

本发明涉及车载全景感知与移动机器人的技术领域，尤其涉及一种全景环带相机与激光雷达联合标定的方法。

背景技术

激光雷达作为各类家用智能机器人、服务机器人、无人小车和车载自动驾驶系统的传感器，具有高精度的测距能力，可以准确快速地获取环境物体的相对空间坐标。全景环带相机有一颗全景环形透镜(Panoramic Annular Lens，PAL)的二次反射镜头，能够以单目的方式实现水平360°光学信息的记录，可以以一次成像的方式获取环境物体的颜色信息。360°激光雷达提供全向的距离信息但是信息度单一，分辨率不高；全景环带相机提供RGB图像，分辨率高，但是没有距离信息。将二者结合，发挥各自传感能力的优势，将三维点精确映射到全景环带图像上，形成全景环带与激光雷达融合系统，可以输出更高维度的传感器信息，用以解决三维建图、物体识别等各类环境感知问题。

现有技术中，申请号为201010223750.7的专利文献公开了一种单线激光雷达和CCD相机相互关系的标定方法，基于CCD相机可以弱成像单线激光雷达使用的红外光源的这一条件。首先，在立方体标定键辅助下提取位于扫描面内的虚拟控制点；然后，使用红外滤光片滤掉可见光，仅使红外光成像，然后对有扫描线信息的红外图像进行增强、二值化处理再进行Hough变换，提取两条激光扫描线，扫描线交点即为虚拟控制点在图像中的像坐标。

公开号为CN106556825A的专利公开了一种全景视觉成像系统的联合标定方法。该联合标定方法利用多光束激光雷达和视觉相机针对同一目标景物所采集图像的法向量在空间内平行的原理，建立两幅图像的之间的映射关系，从而实现多光束激光雷达点云图像和视觉相机图像间的联合标定。虽然上述方法可以实现相机和雷达之间的联合标定，但是上述专利采用多个相机，其需要将激光雷达轴线和相机光心垂直，且还要转到完全一样的角度，存在操作复杂，很难在实际中应用的问题。

发明内容

本发明的目的是针对现有技术的缺陷，提供了一种全景环带相机与激光雷达联合标定的方法。

为了实现以上目的，本发明采用以下技术方案：

一种全景环带相机与激光雷达联合标定的方法，包括全景环带相机、激光雷达、棋盘格的标定板，所述全景环带相机置于激光雷达上方，且全景环带相机的光轴与激光雷达的旋转轴重合；标定板置于全景环带相机与激光雷达的共视区域；所述标定板上设有编号；

标定方法包括：

S1.获取激光雷达的点云数据以及全景环带相机的全景环带图像数据；

S2.根据全景环带图像数据标定全景环带相机，得到全景环带相机的相机参数；

S3.提取激光雷达的点云数据中所有标定板上的点云数据，并对提取出的点云数据使用最小二乘法得到每块标定板在激光雷达坐标系下的平面方程；

S4.计算每块标定板在激光雷达坐标系下的平面方程的法向量，并对计算得到的激光雷达点云数据的法向量进行归一化处理；

S5.计算每块标定板在全景环带相机坐标系下的法向量，并对计算得到的全景环带相机图像数据的法向量进行归一化处理；