激光雷达和深度相机联合标定的标定板、标定方法和系统技术方案

本发明专利技术公开了一种激光雷达和深度相机联合标定的标定板、标定方法和系统，属于自主移动机器人技术领域。本发明专利技术利用标定板的特定形状得到观测点在激光雷达坐标系和深度相机坐标系下点、线约束对。至少两次观测得到六个约束对和十二个约束方程，利用最小二乘法求解2D激光雷达和深度相机坐标转换的九个未知变量，从而实现激光雷达和深度相机的联合标定。本发明专利技术解决了现有联合标定方法的标定过程繁琐、数据帧时间不同步等问题。据帧时间不同步等问题。据帧时间不同步等问题。

【技术实现步骤摘要】
激光雷达和深度相机联合标定的标定板、标定方法和系统


[0001]本专利技术属于自主移动机器人
，更具体地，涉及一种激光雷达和深度相机联合标定的标定板、标定方法和系统。

技术介绍

[0002]2D激光雷达和深度相机融合能很好弥补机器人环境感知特征少、受环境光线影响的问题，保障了移动机器人的高精度运行，并极大提高了移动机器人系统的鲁棒性。2D激光雷达和深度相机的联合标定旨在确定2D激光雷达深度相机间的坐标转换关系，但由于2D激光雷达的扫描平面很难在深度相机中发现，很难直接得到观测点在激光雷达坐标系下和深度相机坐标系下的对应关系，必需借助特定的标定板或一定的约束关系得到观测点在两坐标系下的对应位置。
[0003]目前已有方法可以实现2D激光雷达和相机的联合标定，一种典型方法是通过特定的镂空标定板捕获2D激光雷达的扫描特征信息，将标定板放置在显示器上，通过计算机将激光点复现在显示器上，再由相机去观测带有一条激光扫描线背景的标定板，得到相机坐标系和激光雷达坐标系下的对应点，利用最小二乘法求解相机和激光雷达的坐标转换关系；还有一种方法是通过结构化的环境，通过墙柱或墙角特征，利用激光雷达扫描到的点在相机观测到的墙柱或墙角线上作为约束，利用最小二乘法求解出激光雷达坐标系和相机坐标系间的旋转矩阵和平移矩阵。现有标定方法有的对于环境有较强的依赖性，在标定过程中需要进行多个角度观测，这就对环境的空旷性提出了更高的要求；有的观测次数多，需要进行十二次以上的不同角度不同位置才能确定激光雷达和相机的坐标转换关系，标定过程繁琐，效率低下；部分标定方法是在标定模型移动的情况下达到标定的效果，这就带来了深度相机和2D激光雷达观测数据时间同步的问题，时间不同步将会产生数据帧不匹配的现象。

技术实现思路

[0004]针对相关技术的缺陷，本专利技术的目的在于提供一种激光雷达和深度相机联合标定的标定板、标定方法和系统，旨在解决现有联合标定方法的标定过程繁琐、数据帧时间不同步等问题。
[0005]为实现上述目的，本专利技术的一个方面提供了一种2D激光雷达和深度相机联合标定的标定板，包括第一平板、第二平板和第三平板；
[0006]所述第一平板和第二平板均为三角形，所述第一平板的三条边分别为AB边、BC边和AC边，所述第一平板的三条边分别为AD边、DC边和AC边所述第一平板和第二平板的AC边长度相等且重合，且所述第一平板和第二平板不共面；
[0007]所述第一平板的AB边和第二平板的AD边共一个顶点，且AB边与AD边位于所述第三平板所在平面内。
[0008]可选地，还包括第四平板；
[0009]所述第一平板的BC边和第二平板的DC边共一个顶点，且BC边与DC边位于所述第四平板所在平面内。
[0010]本专利技术的另一方面还提供了一种基于上述标定板的联合标定方法，其特征在于，包括以下步骤：
[0011]S1、将所述标定板置于2D激光雷达和深度相机的视野中，获取所述2D激光雷达和深度相机的观测数据；
[0012]S2、拟合所述2D激光雷达的扫描平面与所述第一平板、第二平板和第三平板的三条交线，获取所述三条交线的三个交点，并投影到相机坐标系下，其中，所述三个交点由所述三条交线两两相交得到；
[0013]S3、识别并提取所述标定板上的深度相机观测数据，根据观测数据在相机坐标系下的三维坐标点拟合得到所述第一平板、第二平板和第三平板分别所在的三个平面的平面方程，进而获取三条交线AB、AC、AD的空间直线方程，其中，所述三条交线AB、AC、AD由所述第一平板、第二平板和第三平板分别所在的三个平面两两相交得到；
[0014]S4、判断此时坐标转换参数是否已知；若是，继续执行步骤S5，若否，则执行步骤S6；
[0015]S5、进行误差校验，若通过误差校验，则结束标定过程；若未通过，执行步骤S6；
[0016]S6、利用所述三个交点在所述三条交线AB、AC、AD的空间直线方程上的约束关系，建立约束方程并求解而得到坐标转换参数；然后，调整标定模型相对于所述标定板的位姿，返回步骤S1。
[0017]进一步地，所述步骤S2中，拟合所述2D激光雷达的扫描平面与所述第一平板、第二平板和第三平板的三条交线，获取所述三条交线的三个交点包括：
[0018]识别并提取所述2D激光雷达落在所述标定板上的观测数据，利用相邻两点间的距离和斜率进行直线特征识别和分割，并将分割后的观测点拟合成三条直线；联立三条直线中的任意两条，获得三个交点在2D激光雷达坐标系下的坐标。
[0019]进一步地，所述步骤S2中，按照下列公式将三个交点投影到相机坐标系下：
[0020][0021]式中，式中，表示2D激光雷达坐标系到相机坐标系的旋转矩阵，表示2D激光雷达坐标系到相机坐标系的平移矩阵，为2D激光雷达坐标系下的点坐标，为相机坐标系下的点坐标。
[0022]进一步地，所述步骤S5具体包括：
[0023]改变标定模型或是标定板的位姿，求解所述三个交点以及所述三条交线AB、AC、AD的直线方程，计算所述三个交点各自到所述三条交线AB、AC、AD的距离，若小于等于设定阈值，则判断误差校验已通过，无需修正；若大于所述设定阈值，则执行步骤S6。
[0024]进一步地，所述步骤S6中，利用最小二乘法求解所述约束方程。
[0025]进一步地，所述步骤S1中，设定深度相机左相机坐标系为基准坐标系。
[0026]进一步地，所述步骤S3中，识别并提取所述标定板上的深度相机观测数据包括：
[0027]提取所述第一平板、第二平板和第三平板在深度相机观测下的像素点，根据深度相机提供的SDK函数获取对应像素点在基准坐标系下的三维坐标值。
[0028]本专利技术的又一方面还提供了一种2D激光雷达和深度相机联合标定的标定系统，包括：计算机可读存储介质和处理器；
[0029]所述计算机可读存储介质用于存储可执行指令；
[0030]所述处理器用于读取所述计算机可读存储介质中存储的可执行指令，执行上述的联合标定方法。
[0031]通过本专利技术所构思的以上技术方案，与现有技术相比，能够取得下列有益效果：
[0032]1、标定过程简单、标定效率高。只需要将标定板放置在2D激光雷达和深度相机能共同观测的地方，通过两个不同位置角度的观测数据即可求解出2D激光雷达和深度相机的坐标转换关系。
[0033]2、本专利技术的联合标定方法每次调整位姿后，标定模型和标定板都是静止的，因此避免了2D激光雷达和深度相机数据帧时间不同步问题。
[0034]3、标定板制作简单。标定板只需确保两个具有一定夹角的相交三角面同时与另一个平面相交，三个面两两相交形成三条相交直线，无垂直度和三角面夹角的具体角度要求，普通3D打印即可完成标定板的制作。
[0035]4、无安装条件和环境条件限制。标定过程中对2D激光雷达和深度相机的水平安装和倾斜安装没有限制，对标定环境地面是否水平没有要求。对本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种2D激光雷达和深度相机联合标定的标定板，其特征在于，包括第一平板、第二平板和第三平板；所述第一平板和第二平板均为三角形，所述第一平板的三条边分别为AB边、BC边和AC边，所述第一平板的三条边分别为AD边、DC边和AC边所述第一平板和第二平板的AC边长度相等且重合，且所述第一平板和第二平板不共面；所述第一平板的AB边和第二平板的AD边共一个顶点，且AB边与AD边位于所述第三平板所在平面内。2.如权利要求1所述的标定板，其特征在于，还包括第四平板；所述第一平板的BC边和第二平板的DC边共一个顶点，且BC边与DC边位于所述第四平板所在平面内。3.一种基于权利要求1或2所述标定板的联合标定方法，其特征在于，包括以下步骤：S1、将所述标定板置于2D激光雷达和深度相机的视野中，获取所述2D激光雷达和深度相机的观测数据；S2、拟合所述2D激光雷达的扫描平面与所述第一平板、第二平板和第三平板的三条交线，获取所述三条交线的三个交点，并投影到相机坐标系下，其中，所述三个交点由所述三条交线两两相交得到；S3、识别并提取所述标定板上的深度相机观测数据，根据观测数据在相机坐标系下的三维坐标点拟合得到所述第一平板、第二平板和第三平板分别所在的三个平面的平面方程，进而获取三条交线AB、AC、AD的空间直线方程，其中，所述三条交线AB、AC、AD由所述第一平板、第二平板和第三平板分别所在的三个平面两两相交得到；S4、判断此时坐标转换参数是否已知；若是，继续执行步骤S5，若否，则执行步骤S6；S5、进行误差校验，若通过误差校验，则结束标定过程；若未通过，执行步骤S6；S6、利用所述三个交点在所述三条交线AB、AC、AD的空间直线方程上的约束关系，建立约束方程并求解而得到坐标转换参数；然后，调整标定模型相对于所述标定板的位姿，返回步骤S1。4.如权利要求3所述的联合标定方法，其特征在于，所述步骤S2中，拟合所述2D激...

【专利技术属性】
技术研发人员：周伟，陈海伦，何凯，崔家旭，柳冠伊，
申请(专利权)人：中国科学院深圳先进技术研究院，
类型：发明
国别省市：