基于L型标定板的相机和激光雷达联合标定的方法技术

本发明专利技术涉及一种基于L型标定板的相机和激光雷达联合标定的方法。首先，将相机与激光雷达安装在待标定设备上；其次，把L型标定板置于待标定设备视场内的地面上；开启相机与激光雷达，进行数据采集，获取包含L型标定板的图像与点云数据；对图像数据进行角点检测，得到L型标定板两个平面上特征角点的像素坐标；对点云数据进行平面分割与拟合，得到L型标定板两个平面的方程，并通过几何信息进而得到平面上的特征角点在激光雷达坐标系下的坐标；最后，基于所检测角点的像素坐标与在激光雷达坐标系下的坐标，计算得到所述相机与激光雷达的位姿变化。本发明专利技术可以准确获取角点特征在点云数据中的位置，极大提升了相机和激光雷达联合标定的准确率。准确率。准确率。

【技术实现步骤摘要】
基于L型标定板的相机和激光雷达联合标定的方法


[0001]本专利技术涉及标定领域中的相机和激光雷达联合标定，特别涉及一种基于L型标定板的相机和激光雷达联合标定的方法。

技术介绍

[0002]自动驾驶汽车使用各种传感器来感知环境，为了实现复杂环境中的高质量感知，需要融合多种不同的传感数据来实现更全面的感知。在自动驾驶系统中，最为普遍使用的传感器是RGB相机和多线激光雷达。RGB相机能够获取高分辨率的颜色和纹理信息，但无法从图像数据中得到高精度的深度信息。激光雷根据发射和接受激光的时间差，提供被探测点准确的距离与方位等信息，在夜间也能很好地工作，然而，激光雷达不提供检测点的颜色信息，而且高线束的激光雷达设备价格昂贵，低线束的激光雷达设备只能获得有限的稀疏点云。
[0003]相机和激光雷达在数据层面是互补的，稠密的场景信息与稀疏的点云信息融合可以提升自动驾驶的性能。为了实现高质量的传感融合，相机和激光雷达的外参标定是重要的一环，外参标定也称为位姿变换的求解，只有得到了相机和激光雷达之间准确的坐标系变换关系，才能将相机图像数据和激光雷达点云数据进行精确的匹配，从而实现二者数据的融合。
[0004]相机和激光雷达联合标定通常依赖于标定板，标定板能提供精确的几何尺寸信息，相机和激光雷达先获取标定板中的多个特征点坐标，利用相机坐标系和激光雷达坐标系中匹配的特征来计算二者的外参。然而，对于低线束激光雷达，由于点云的稀疏性，其无法准确得到标定板的特征点在空间中的具体位置，造成图像中的特征点和空间中对应点的匹配误差增加，从而降低了相机和激光雷达外参标定的精度。

技术实现思路

[0005]本专利技术的目的在于提供一种基于L型标定板的相机和激光雷达联合标定的方法，该方法克服现有标定存在的问题，其原理简单、效率高，可以在低线束的激光雷达下实现准确的标定，能满足自动驾驶领域中相机和激光雷达的联合标定。
[0006]为实现上述目的，本专利技术的技术方案是：一种基于L型标定板的相机和激光雷达联合标定的方法，包括：
[0007]将相机与激光雷达安装在待标定设备上；
[0008]将L型标定板置于待标定相机与激光雷达设备的视场内的地面上；
[0009]开启相机与激光雷达，进行数据采集，从相机获取包括L型标定板的图像数据，从激光雷达获取包括L型标定板的点云数据；
[0010]对获取的图像数据进行角点检测，得到L型标定板两个平面上的棋盘格角点在像素坐标系下的坐标；
[0011]对获取的点云数据进行平面分割与拟合，得到L型标定板两个平面的方程，通过几
何信息，进而得到L型标定板两个平面上的棋盘格角点在激光雷达坐标系下的坐标；
[0012]基于L型标定板的角点在像素坐标系下的坐标，与L型标定板的角点在激光雷达坐标系下的坐标，计算得到相机与激光雷达的位姿变化。
[0013]在本专利技术一实施例中，所述将L型标定板置于待标定相机与激光雷达设备的视场内的地面上的具体实现步骤如下：
[0014]获取两个尺寸已知的棋盘平面标定板，两个棋盘平面标定板的标定平面上设置有角点数量不同的棋盘格作为标定特征；
[0015]将两个棋盘平面标定板的边缘拼接，组成L型标定板，两个棋盘平面互相垂直，定义为平面π1与平面π2。
[0016]在本专利技术一实施例中，所述开启相机与激光雷达，进行数据采集的具体实现步骤如下：
[0017]预设数据采集的时间间隔，待相机与激光雷达运行稳定后，对L型标定板进行数据采集；
[0018]移动待标定设备，采集得到N组同步的图像数据与点云数据，在采集过程中要确保L型标定板在相机与激光雷达的视场内。
[0019]在本专利技术一实施例中，所述对获取的图像数据进行角点检测，得到L型标定板两个平面上的棋盘格角点在像素坐标系下的坐标的具体实现步骤如下：
[0020]根据L型标定板中平面π1的角点数量，检测得到该平面角点在像素坐标系下的坐标；
[0021]根据L型标定板中平面π2的角点数量，检测得到该平面角点在像素坐标系下的坐标。
[0022]在本专利技术一实施例中，所述对获取的点云数据进行平面分割与拟合，得到L型标定板两个平面的方程，通过几何信息，进而得到L型标定板两个平面上的棋盘格角点在激光雷达坐标系下的坐标的具体实现步骤如下：
[0023]基于L型标定板的尺寸与位置对点云进行初步分割，分割得到的点云数据包括L型标定板与邻近地面的点云数据；
[0024]基于邻近信息对点云数据信息再次分割，分割得到三部分点云数据，分别为L型标定板中平面π1、L型标定板中平面π2、地面π3的点云数据；
[0025]利用RANSAC和最小二乘法进行平面拟合，平面的一般方程为aX+bY+cZ+d＝0，其中a、b、c、d为平面参数，得到L型标定板两个平面与地面的方程：
[0026]a1X+b1Y+c1Z+d1＝0
[0027]a2X+b2Y+c2Z+d2＝0
[0028]a3X+b3Y+c3Z+d3＝0
[0029]其中，第一个方程代表L型标定板的平面π1，第二个方程代表L型板的平面π2，第三个方程代表地面π3；三个平面π1、π2、π3的法向量分别为
[0030]联立三个平面π1、π2、π3的法向量方程，计算得到三个平面的交点在激光雷达坐标系下的坐标(x0,y0,z0)；
[0031]将三个平面的法向量两两进行叉乘，计算得到平面π1与平面π2的交线方向l
12
，平面π1与平面π3的交线方向l
13
，平面π2与平面π3的交线方向l
23
；
[0032]L型标定板的尺寸已知，L型标定板的原点定义为三个平面的交点，L型标定板中平面π1与π2上的角点坐标可以用交线方向分别计算得到，
[0033][0034][0035]其中，i代表第i行角点，j代表第j列角点，L型标定板上每个棋盘格的尺寸为D；根据公式计算得到L型标定板上的所有角点在激光雷达坐标系下的坐标。
[0036]在本专利技术一实施例中，所述基于L型标定板的角点在像素坐标系下的坐标，与L型标定板的角点在激光雷达坐标系下的坐标，计算得到相机与激光雷达的位姿变化的具体实现步骤如下：
[0037]定义空间中的一点在像素坐标系下的坐标为[u,v]T
，在激光雷达坐标系下的坐标为
L
p＝[
L
p
x
,
L
p
y
,
L
p
z
]T
，在相机坐标系下的坐标为
C
p＝[
C
p
x
，
C
p
y
，
C
p
z
]T
；
[0038]给定相机的内参矩阵K，相机坐标系下的点
C
p投影到像素坐标系得到对应点[u,v]本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于L型标定板的相机和激光雷达联合标定的方法，其特征在于，包括：将相机与激光雷达安装在待标定设备上；将L型标定板置于待标定相机与激光雷达设备的视场内的地面上；开启相机与激光雷达，进行数据采集，从相机获取包括L型标定板的图像数据，从激光雷达获取包括L型标定板的点云数据；对获取的图像数据进行角点检测，得到L型标定板两个平面上的棋盘格角点在像素坐标系下的坐标；对获取的点云数据进行平面分割与拟合，得到L型标定板两个平面的方程，通过几何信息，进而得到L型标定板两个平面上的棋盘格角点在激光雷达坐标系下的坐标；基于L型标定板的角点在像素坐标系下的坐标，与L型标定板的角点在激光雷达坐标系下的坐标，计算得到相机与激光雷达的位姿变化。2.根据权利要求1所述的基于L型标定板的相机和激光雷达联合标定的方法，其特征在于，所述将L型标定板置于待标定相机与激光雷达设备的视场内的地面上的具体实现步骤如下：获取两个尺寸已知的棋盘平面标定板，两个棋盘平面标定板的标定平面上设置有角点数量不同的棋盘格作为标定特征；将两个棋盘平面标定板的边缘拼接，组成L型标定板，两个棋盘平面互相垂直，定义为平面π1与平面π2。3.根据权利要求1所述的基于L型标定板的相机和激光雷达联合标定的方法，其特征在于，所述开启相机与激光雷达，进行数据采集的具体实现步骤如下：预设数据采集的时间间隔，待相机与激光雷达运行稳定后，对L型标定板进行数据采集；移动待标定设备，采集得到N组同步的图像数据与点云数据，在采集过程中要确保L型标定板在相机与激光雷达的视场内。4.根据权利要求1所述的基于L型标定板的相机和激光雷达联合标定的方法，其特征在于，所述对获取的图像数据进行角点检测，得到L型标定板两个平面上的棋盘格角点在像素坐标系下的坐标的具体实现步骤如下：根据L型标定板中平面π1的角点数量，检测得到该平面角点在像素坐标系下的坐标；根据L型标定板中平面π2的角点数量，检测得到该平面角点在像素坐标系下的坐标。5.根据权利要求1所述的基于L型标定板的相机和激光雷达联合标定的方法，其特征在于，所述对获取的点云数据进行平面分割与拟合，得到L型标定板两个平面的方程，通过几何信息，进而得到L型标定板两个平面上的棋盘格角点在激光雷达坐标系下的坐标的具体实现步骤如下：基于L型标定板的尺寸与位置对点云进行初步分割，分割得到的点云数据包括L型标定板与邻近地面的点云数据；基于邻近信息对点云数据信息再次分割，分割得到三部分点云数据，分别为L型标定板中平面π1、L型标定板中平面π2、地面π3的点云数据；利用RANSAC和最小二乘法进行平面拟合，平面的一般方程为aX+bY+cZ+d＝0，其中a、b、c、d为平面参数，得到L型标定板两个平面与地面的方程：
a1X+b1Y+c1Z+d1＝0a2X+b2Y+c2Z+d2＝0a3X+b3Y+c3...

【专利技术属性】
技术研发人员：刘思宁，吴林煌，
申请(专利权)人：福州视驰科技有限公司，
类型：发明
国别省市：