《一种标定方法、装置及设备.pdf》由会员分享，可在线阅读，更多相关《一种标定方法、装置及设备.pdf（16页珍藏版）》请在专利查询网上搜索。
1、10申请公布号CN104142157A43申请公布日20141112CN104142157A21申请号201310162869122申请日20130506G01C25/00200601G01S7/49720060171申请人北京四维图新科技股份有限公司地址100028北京市朝阳区曙光西里甲5号凤凰置地广场A座写字楼17层72发明人晏阳孟磊王雷斌曹晓航74专利代理机构北京银龙知识产权代理有限公司11243代理人许静黄灿54发明名称一种标定方法、装置及设备57摘要本发明实施例还提供一种标定方法、装置及设备。所述方法包括第一确定步骤，对于至少三个标定点中的每个标定点，确定所述每个标定点在激光雷达坐标。
2、系下的点云坐标和在全景相机的全景图像坐标系下的像素坐标；第二确定步骤，根据所述至少三个标定点各自对应的点云坐标和像素坐标，确定用于对激光雷达和全景相机进行联合标定的标定参数。本发明实施例提供了不依赖于带有强度的激光点云数据的标定激光雷达和全景相机的方式。51INTCL权利要求书2页说明书10页附图3页19中华人民共和国国家知识产权局12发明专利申请权利要求书2页说明书10页附图3页10申请公布号CN104142157ACN104142157A1/2页21一种标定方法，其特征在于，所述方法包括第一确定步骤，对于至少三个标定点中的每个标定点，确定所述每个标定点在激光雷达坐标系下的点云坐标和在全景相。
3、机的全景图像坐标系下的像素坐标；其中，标定点位于标定物上；第二确定步骤，根据所述至少三个标定点各自对应的点云坐标和像素坐标，确定用于对激光雷达和全景相机进行联合标定的标定参数。2根据权利要求1所述的方法，其特征在于，标定物为激光雷达，所述第一确定步骤中，所述至少三个标定点中的任一标定点在激光雷达坐标系下的点云坐标根据如下方式确定根据激光雷达工程设计参数，确定所述点云坐标。3根据权利要求1所述的方法，其特征在于，所述第一确定步骤中，对于所述至少三个标定点中的任一标定点，所述任一标定点所在的处于第一位置的第一标定物的底面与激光雷达坐标系的第一坐标轴垂直，所述第一标定物的包含所述任一标定点的第一边缘。
4、与所述第一标定物的底面垂直，且所述至少三个标定点中的任一标定点在激光雷达坐标系下的点云坐标根据如下方式确定根据激光雷达扫描所述第一标定物得到的激光点云数据，确定所述第一边缘在激光雷达坐标系的第二坐标轴上的第二坐标值和在激光雷达坐标系的第三坐标轴上的第三坐标值；根据所述第二坐标值、所述第三坐标值和所述任一标定点到所述底面的高度，确定所述任一标定点在激光雷达坐标系下的点云坐标。4根据权利要求1所述的方法，其特征在于，所述第一确定步骤中，所述至少三个标定点中的任一标定点在全景相机的全景图像坐标系下的像素坐标根据如下方式确定根据全景相机拍摄所述任一标定点所在的处于第二位置的第二标定物得到的图像，确定所。
5、述任一标定点在所述图像中的第一像素；将所述图像中所述第一像素的坐标确定为所述任一标定点在全景相机的全景图像坐标系下的像素坐标。5根据权利要求1所述的方法，其特征在于，所述标定参数包括激光雷达坐标系到全景相机的全景图像坐标系下的旋转矩阵和平移矩阵。6一种标定装置，其特征在于，所述装置包括第一确定模块，用于对于至少三个标定点中的每个标定点，确定所述每个标定点在激光雷达坐标系下的点云坐标和在全景相机的全景图像坐标系下的像素坐标；其中，标定点位于标定物上；第二确定模块，用于根据所述至少三个标定点各自对应的点云坐标和像素坐标，确定用于对激光雷达和全景相机进行联合标定的标定参数。7根据权利要求6所述的装置。
6、，其特征在于，标定物为激光雷达，所述第一确定模块中，所述至少三个标定点中的任一标定点在激光雷达坐标系下的点云坐标根据如下方式确定根据激光雷达工程设计参数，确定所述点云坐标。8根据权利要求6所述的装置，其特征在于，所述第一确定模块中，对于所述至少三个权利要求书CN104142157A2/2页3标定点中的任一标定点，所述任一标定点所在的处于第一位置的第一标定物的底面与激光雷达坐标系的第一坐标轴垂直，所述第一标定物的包含所述任一标定点的第一边缘与所述第一标定物的底面垂直，且所述至少三个标定点中的任一标定点在激光雷达坐标系下的点云坐标根据如下方式确定根据激光雷达扫描所述第一标定物得到的激光点云数据，确。
7、定所述第一边缘在激光雷达坐标系的第二坐标轴上的第二坐标值和在激光雷达坐标系的第三坐标轴上的第三坐标值；根据所述第二坐标值、所述第三坐标值和所述任一标定点到所述底面的高度，确定所述任一标定点在激光雷达坐标系下的点云坐标。9根据权利要求6所述的装置，其特征在于，所述第一确定模块中，所述至少三个标定点中的任一标定点在全景相机的全景图像坐标系下的像素坐标根据如下方式确定根据全景相机拍摄所述任一标定点所在的处于第二位置的第二标定物得到的图像，确定所述任一标定点在所述图像中的第一像素；将所述图像中所述第一像素的坐标确定为所述任一标定点在全景相机的全景图像坐标系下的像素坐标。10根据权利要求6所述的装置，其。
8、特征在于，所述标定参数包括激光雷达坐标系到全景相机的全景图像坐标系下的旋转矩阵和平移矩阵。11一种设备，其特征在于，所述设备包括如权利要求6至10中任一项所述的标定装置。权利要求书CN104142157A1/10页4一种标定方法、装置及设备技术领域0001本发明涉及测绘领域，尤其涉及一种标定方法、装置及设备。背景技术0002移动测绘系统中的一项重要功能是通过数据融合得到的多模态数据，基于图像的目标定位与量测，数据质量的保证依赖于全景相机与激光雷达精确的标定。0003现有的标定方法，在预订标定场地，采集多组全景与点云数据，通过肉眼观察找到点云中可识别物体边缘，然后调整点云使其与全景图像中对应物体。
9、边缘匹配、记录点云的调整的旋转与平移矩阵，再通过优化算法得到最优标定结果。0004但是，这种方法依赖于带有强度的激光点云数据，而如果激光雷达获得的激光点云数据不带强度，则由于激光点的具体位置不可见，无法与对应图像进行很好的匹配，就无法通过这种方法来得到标定结果，因此，这种方法的适用范围较窄。发明内容0005有鉴于此，本发明实施例的目的是提供一种标定方法、装置及设备，以提供不依赖于带有强度的激光点云数据的标定激光雷达和全景相机的方法。0006为解决上述技术问题，本发明实施例提供方案如下0007本发明实施例提供一种标定方法，所述方法包括0008第一确定步骤，对于至少三个标定点中的每个标定点，确定所。
10、述每个标定点在激光雷达坐标系下的点云坐标和在全景相机的全景图像坐标系下的像素坐标；其中，标定点位于标定物上；0009第二确定步骤，根据所述至少三个标定点各自对应的点云坐标和像素坐标，确定用于对激光雷达和全景相机进行联合标定的标定参数。0010优选的，标定物为激光雷达，所述第一确定步骤中，所述至少三个标定点中的任一标定点在激光雷达坐标系下的点云坐标根据如下方式确定0011根据激光雷达工程设计参数，确定所述点云坐标。0012优选的，所述第一确定步骤中，对于所述至少三个标定点中的任一标定点，所述任一标定点所在的处于第一位置的第一标定物的底面与激光雷达坐标系的第一坐标轴垂直，所述第一标定物的包含所述任。
11、一标定点的第一边缘与所述第一标定物的底面垂直，且所述至少三个标定点中的任一标定点在激光雷达坐标系下的点云坐标根据如下方式确定0013根据激光雷达扫描所述第一标定物得到的激光点云数据，确定所述第一边缘在激光雷达坐标系的第二坐标轴上的第二坐标值和在激光雷达坐标系的第三坐标轴上的第三坐标值；0014根据所述第二坐标值、所述第三坐标值和所述任一标定点到所述底面的高度，确定所述任一标定点在激光雷达坐标系下的点云坐标。0015优选的，所述第一确定步骤中，所述至少三个标定点中的任一标定点在全景相机说明书CN104142157A2/10页5的全景图像坐标系下的像素坐标根据如下方式确定0016根据全景相机拍摄所。
12、述任一标定点所在的处于第二位置的第二标定物得到的图像，确定所述任一标定点在所述图像中的第一像素；0017将所述图像中所述第一像素的坐标确定为所述任一标定点在全景相机的全景图像坐标系下的像素坐标。0018优选的，所述标定参数包括激光雷达坐标系到全景相机的全景图像坐标系下的旋转矩阵和平移矩阵。0019本发明实施例还提供一种标定装置，所述装置包括0020第一确定模块，用于对于至少三个标定点中的每个标定点，确定所述每个标定点在激光雷达坐标系下的点云坐标和在全景相机的全景图像坐标系下的像素坐标；其中，标定点位于标定物上；0021第二确定模块，用于根据所述至少三个标定点各自对应的点云坐标和像素坐标，确定用。
13、于对激光雷达和全景相机进行联合标定的标定参数。0022优选的，标定物为激光雷达，所述第一确定模块中，所述至少三个标定点中的任一标定点在激光雷达坐标系下的点云坐标根据如下方式确定0023根据激光雷达工程设计参数，确定所述点云坐标。0024优选的，所述第一确定模块中，对于所述至少三个标定点中的任一标定点，所述任一标定点所在的处于第一位置的第一标定物的底面与激光雷达坐标系的第一坐标轴垂直，所述第一标定物的包含所述任一标定点的第一边缘与所述第一标定物的底面垂直，且所述至少三个标定点中的任一标定点在激光雷达坐标系下的点云坐标根据如下方式确定0025根据激光雷达扫描所述第一标定物得到的激光点云数据，确定所。
14、述第一边缘在激光雷达坐标系的第二坐标轴上的第二坐标值和在激光雷达坐标系的第三坐标轴上的第三坐标值；0026根据所述第二坐标值、所述第三坐标值和所述任一标定点到所述底面的高度，确定所述任一标定点在激光雷达坐标系下的点云坐标。0027优选的，所述第一确定模块中，所述至少三个标定点中的任一标定点在全景相机的全景图像坐标系下的像素坐标根据如下方式确定0028根据全景相机拍摄所述任一标定点所在的处于第二位置的第二标定物得到的图像，确定所述任一标定点在所述图像中的第一像素；0029将所述图像中所述第一像素的坐标确定为所述任一标定点在全景相机的全景图像坐标系下的像素坐标。0030优选的，所述标定参数包括激光。
15、雷达坐标系到全景相机的全景图像坐标系下的旋转矩阵和平移矩阵。0031本发明实施例还提供一种包括以上所述的标定装置的设备。0032从以上所述可以看出，本发明实施例至少具有如下有益效果0033通过确定至少三个标定点中的每个标定点的点云坐标和像素坐标，并根据所述至少三个标定点各自对应的点云坐标和像素坐标，确定用于对激光雷达和全景相机进行联合标定的标定参数，从而提供了不依赖于带有强度的激光点云数据的标定激光雷达和全景相机的方式。说明书CN104142157A3/10页6附图说明0034图1表示本发明实施例提供的一种标定方法的流程示意图；0035图2表示全景相机与激光雷达标定参数解算模块结构图；0036。
16、图3表示全景相机与激光雷达标定参数解算流程示意图；0037图4表示激光雷达外部几何轮廓的角点坐标确定示意图；0038图5表示标定物的角点坐标确定示意图；0039图6A表示平移矩阵计算示意图；0040图6B表示旋转矩阵计算示意图。具体实施方式0041为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合附图及具体实施例对本发明实施例进行详细描述。0042图1表示本发明实施例提供的一种标定方法的流程示意图，参照图1，本发明实施例提供一种标定方法，所述方法包括如下步骤0043第一确定步骤101，对于至少三个标定点中的每个标定点，确定所述每个标定点在激光雷达坐标系下的点云坐标和在全景相机的全景图像。
17、坐标系下的像素坐标；其中，标定点位于标定物上；0044第二确定步骤102，根据所述至少三个标定点各自对应的点云坐标和像素坐标，确定用于对激光雷达和全景相机进行联合标定的标定参数。0045可见，通过确定至少三个标定点中的每个标定点的点云坐标和像素坐标，并根据所述至少三个标定点各自对应的点云坐标和像素坐标，确定用于对激光雷达和全景相机进行联合标定的标定参数，从而提供了不依赖于带有强度的激光点云数据的标定激光雷达和全景相机的方式。0046由于本实施例提供的方式不需要激光雷达产生带有强度的激光点云数据，因此，适用范围更广。0047在本发明实施例中，激光雷达坐标系可以为以激光雷达的激光源为坐标原点的三维。
18、直角坐标系。0048全景相机的全景图像坐标系可以为全景相机所拍摄图像对应的平面直角坐标系，其中，该平面直角坐标系的坐标原点可以为在所拍摄图像中位于特定行、特定列的像素，则所述像素坐标则可以为所述每个标定点在全景相机所拍摄图像中对应的像素的坐标。以平面直角坐标系的坐标原点在所拍摄图像中位于第1行、第1列、所述每个标定点在全景相机所拍摄图像中对应的像素位于第5行、第8列为例，则所述像素坐标为（4，7）或（4，7）。0049在本发明实施例中，标定点在激光雷达坐标系下的点云坐标可以通过实验的方式获得。0050在本发明实施例中，标定点可以为标定物外部几何角点。0051标定物的形状可以为长方体（包括立方体。
19、）、棱柱体、圆柱体等。0052不同标定点所在标定物可以完全相同或不完全相同。0053不同标定点所在标定物所处于的位置可以完全相同或不完全相同。说明书CN104142157A4/10页70054标定物可以包括激光雷达和/或激光雷达之外的物体（如长方体的箱子）。0055下面就不同的情况分别进行说明。00560057对于标定物包括激光雷达的情况，可以有0058所述第一确定步骤中，所述至少三个标定点中的任一标定点在激光雷达坐标系下的点云坐标根据如下方式确定0059根据激光雷达工程设计参数，确定所述点云坐标。0060这里，激光雷达工程设计参数记载在激光雷达的工程设计说明书中。下面以形状为长方体的激光雷达。
20、为例，说明根据激光雷达工程设计参数确定所述点云坐标的具体方式。0061参照图4，激光雷达为长方体，激光源位于激光雷达的中心，是激光雷达坐标系的坐标原点（图中的O点），激光雷达坐标系的坐标轴为X轴、Y轴和Z轴，分别垂直于激光雷达的三对面。激光雷达工程设计参数为所述激光源到激光雷达外表面的距离，包括所述激光源到图示的正表面的距离LX；所述激光源到图示的右侧面的距离LY；以及所述激光源到图示的上表面的距离LZ。则图示的XYZ处的角点的点云坐标即为（LX，LY，LZ）。0062对于激光雷达为立方体的情况，同理亦可得到激光雷达的其它角点的点云坐标；0063对于激光雷达不为立方体的情况，所述激光源到激光雷。
21、达外表面的距离还可以包括所述激光源到图示的后表面的距离LX；所述激光源到图示的左侧面的距离LY；以及所述激光源到图示的下表面的距离LZ。则激光雷达的任一角点的点云坐标均可以通过类似方式得到，例如，图中最右上角的角点的点云坐标为（LX，LY，LZ）。0064上述例子是为了说明根据激光雷达工程设计参数确定所述点云坐标是能够为本领域技术人员所实现的。当然，本领域技术人员也应当明白，对于其它形状的激光雷达，只要根据激光雷达工程设计参数确定激光雷达外表面的至少三个点各自与激光源在X、Y及Z轴上的偏移，就能够确定所述点云坐标，这只不过需要一些简单的数学运算知识，为节约篇幅，在此不再赘述。0065由于上述方。
22、式使用了精确的激光雷达工程设计参数，因此，由此而得到的点云坐标也非常精确。00660067对于标定物包括激光雷达之外的物体的情况和/或标定物可以被激光雷达扫描到的情况，可以有0068所述第一确定步骤中，对于所述至少三个标定点中的任一标定点，所述任一标定点所在的处于第一位置的第一标定物的底面与激光雷达坐标系的第一坐标轴垂直，所述第一标定物的包含所述任一标定点的第一边缘与所述第一标定物的底面垂直，且所述任一标定点在激光雷达坐标系下的点云坐标根据如下方式确定0069根据激光雷达扫描所述第一标定物得到的激光点云数据，确定所述第一边缘在激光雷达坐标系的第二坐标轴上的第二坐标值和在激光雷达坐标系的第三坐标。
23、轴上的第三坐标值；0070根据所述第二坐标值、所述第三坐标值和所述任一标定点到所述底面的高度，确定所述任一标定点在激光雷达坐标系下的点云坐标。说明书CN104142157A5/10页80071其中，第一坐标轴可以为X轴、Y轴或Z轴。下面以第一坐标轴为Z轴为例，结合图5，对所述根据所述第二坐标值、所述第三坐标值和所述任一标定点到所述底面的高度，确定所述任一标定点在激光雷达坐标系下的点云坐标的方式加以说明。0072如图5所示，第一标定物为长方体状物体，放置在水平面的某位置上，激光雷达的放置使得激光雷达坐标系的X轴和Y轴位于该水平面上，则第一坐标轴与第一标定物的底面垂直。第一标定物可以放置在激光雷达。
24、的可扫描区域和全景相机的可拍摄区域的交集区域内的任一位置。图中所示为第一标定物放置在该交集区域内的位置I的情形，L为激光雷达扫描到第一标定物后形成的点云，其中LI，LI1为激光雷达在第一标定物边缘上留下的点云（如果激光不能打到第一标定物边缘，可通过逐步提高激光雷达的采样频率获得多组不同密度的激光点云来解决），因此在LI点的点云坐标已知（LXI，LYI，LZI），又第一标定物的高度H已知可得到第一标定物的角点PI的坐标为（LXI，LYI，H），同理可获得标定物的角点PI1的坐标。0073其中，边缘处的点云可以通过对不同的点云到激光源的距离进行比较得到，例如，设LI点云到激光源的距离为DI，LI1。
25、点云到激光源的距离为DI1，则0074（1）LI左侧第一个点云到激光源的距离DILI右侧第一个点云到激光源的距离，且LI左侧第一个点云到激光源的距离与DI之差，要远远大于DI与LI右侧第一个点云到激光源的距离之差；0075（2）LI1左、右侧的点云各自到激光源的距离均大于DI1。0076由此，可以从L表示的点云中选择满足如下条件的点云作为LI点云0077设被选择的点云到激光源的距离为E，被选择的点云的左侧第一个点云到激光源的距离为F，被选择的点云的右侧第一个点云到激光源的距离为G，则FEG且FEEG；0078选择满足如下条件的点云作为LI1点云0079设被选择的点云到激光源的距离为E，被选择的。
26、点云的左侧第一个点云到激光源的距离为F，被选择的点云的右侧第一个点云到激光源的距离为G，则FE且GE。0080进一步地，将标定物从位置I更换到位置J时，则第一标定物为处于位置I的标定物，更换后的PI点或PI1点为不同更换前的PI点或PI1点的其它标定点更换后的标定物为第二标定物，则可得到更换后的PI点或PI1点的点云坐标，也就是其它标定点的点云坐标。由此，就可以得到三个标定点的点云坐标。0081而通过位置的更换，可以使标定物在不同时间处于N个位置，N1，则通过上述方式可以得到N2个标定点的点云坐标。0082其中，标定物的摆放的位置可以在相同的水平面上，也可以在不同的水平面上。当标定物的摆放的位。
27、置不在同一水平面上时，可使用全站仪分别测量指定角点的坐标，对Z轴坐标做减法，可获得两个位置上水平高度差，由此则可以得到摆放在不同水平面上的标定物的角点的Z轴坐标。0083这种方法只使用激光雷达获得XY两个二维坐标，Z轴上的坐标即为标定物角点的高度H。与人工调整点云与全景匹配不同，人工调整点云的维度是三维的，而这种方法获得的坐标是二维的，不会出现在视觉深度方向的误差。0084这里是以标定物的形状为长方体为例进行的说明。对于标定物为棱柱体或圆柱体的情况，可以通过与上述例子类似的方式确定标定物与水平面垂直的边缘的二维坐标，进说明书CN104142157A6/10页9而根据标定物角点的高度确定该角点的。
28、三维坐标，即可得到该角点的点云坐标，为节约篇幅，在此不再赘述。0085需要说明的是，对于标定物为圆柱体的情况，从激光雷达方向看起来，圆柱体也存在与圆柱体的底面垂直的两条边，则标定物角点可以为其中任一条边与圆柱体的上底面或下底面的交点。00860087对于标定物包括激光雷达和/或激光雷达之外的物体的情况，至少三个标定点中的一部分标定点可以为激光雷达的外部几何的角点，另一部分标定点可以为激光雷达之外的物体的外部几何的角点。则可以采用情况一中给出的方式确定激光雷达外部几何的角点的点云坐标，以及采用情况二中给出的方式确定激光雷达之外的物体和/或可以被激光雷达扫描到的物体的外部几何的角点的点云坐标，本领。
29、域技术人员能够清楚地知道如何实现，为节约篇幅，在此不再赘述。0088在本发明实施例中，所述第一确定步骤中，所述至少三个标定点中的任一标定点在全景相机的全景图像坐标系下的像素坐标根据如下方式确定0089根据全景相机拍摄所述任一标定点所在的处于第二位置的第二标定物得到的图像，确定所述任一标定点在所述图像中的第一像素；0090将所述图像中所述第一像素的坐标确定为所述任一标定点在全景相机的全景图像坐标系下的像素坐标。0091所述第一确定步骤中，至少三个标定点所在的标定物可以完全相同，也可以不完全相同。0092至少三个标定点所在的标定物所处于的位置可以完全相同，也可以不完全相同。0093在至少三个标定点。
30、中，对于所在标定物为处于激光雷达扫描范围内的物体的第一标定点，全景相机在拍摄所述所在标定物时所述所在标定物所处于的位置，与激光雷达为获取激光点云数据而进行激光扫描时所述所在标定物所处于的位置相同；其中，该激光点云数据用于确定该第一标定点在激光雷达坐标系下的点云坐标。0094所述根据全景相机拍摄所述任一标定点所在的处于第一位置的第一标定物得到的图像，确定所述任一标定点在所述图像中的第一像素可以有多种方式0095例如，根据操作人员在所述图像中的点选来确定所述任一标定点在所述图像中所在的像素。0096更精确地，可以采用计算机模式识别的方式；或者，先根据操作人员在所述图像中的点选来确定所述任一标定点在。
31、所述图像中所在的像素范围，再通过计算机模式识别的方式来确定所述第一像素；等等。0097在本发明实施例中，所述标定参数可以包括激光雷达坐标系（P1）到全景相机的全景图像坐标系（P2）下的旋转矩阵和平移矩阵。0098所述至少三个标定点的标定点个数可以为三个，则所述第二确定步骤102具体可以包括0099根据所述至少三个标定点各自对应的点云坐标和像素坐标，确定所述平移矩阵；0100根据所述平移矩阵和所述至少三个标定点各自对应的点云坐标和像素坐标，确定所述旋转矩阵。说明书CN104142157A7/10页100101下面结合图6A和图6B，对所述平移矩阵及所述旋转矩阵的确定方式进行说明。三个标定点（C1。
32、、C2和C3）中的每个标定点在P1下的点云坐标和在P2下的像素坐标组成一组标定坐标对，则三个标定点共组成三组标定坐标对。应用不同坐标系下角度的旋转不变性定律，计算出平移矩阵T，再通过计算得到的平移矩阵TDX,DY,DZ，计算出旋转矩阵RAY,AP,AR。0102现架设有两个传感器，P1为激光雷达、P2为全景相机，有两个标定点C1和C2都可以被P1和P2探测到，在P1坐标系下坐标为C1P1和C2P1，在P2坐标系下坐标为C1P2和C2P2，由于P2坐标系下C1，C2只有方向，没有深度，所以只能获得的值，另，在P1到P2坐标系的变换过程中不变，遂坐标C1P1C2P1与平移向量T相减之后，亦为，可建。
33、立方程，选取3个点即可得到平移向量T，通过三个标定点和求得的平移向量可以求出两个坐标系的旋转矩阵R。0103具体地，在P2坐标系下，只能知道方向向量010401050106它们形成C1P2C2。0107在P1和P2坐标系下大小是相同的（旋转不变性），在P1坐标系下01080109在P2坐标系下01100111所以01120113可以求解平移矩阵T。0114再根据如下三个方程，可以求解得到旋转矩阵R0115C1P2RC1P1T0116C2P2RC2P1T0117C3P2RC3P1T0118在上述三个方程中，T已知，R矩阵有三个未知数，因而可解得旋转矩阵R。0119在本发明实施例中，为了进一步提高。
34、标定参数的精度，所述至少三个标定点的标说明书CN104142157A108/10页11定点个数也可以为大于三个，则所述第二确定步骤102具体可以包括0120从所述至少三个标定点中选择至少两组标定点，其中，所述至少两组标定点中的每组标定点的标定点个数为三个，所述至少两组标定点中的两两组标定点之间不完全相同；0121根据所述每组标定点各自对应的点云坐标和像素坐标，确定所述每组标定点对应的候选的标定参数；0122使用RANSAC（RANDOMSAMPLECONSENSUS）方法对所述至少两组标定点各自对应的候选的标定参数进行评价，得到最优的标定参数；0123将所述最优的标定参数作为所述第二确定步骤1。
35、02中确定的用于对激光雷达和全景相机进行联合标定的标定参数。0124例如，对于所述至少三个标定点的标定点个数为四个的情况，可以通过上述方式确定除C1、C2和C3之外的第四标定点所对应的点云坐标和像素坐标。则通过上述方式，根据所述三个标定点中的两个标定点与第四标定点所各自对应的点云坐标和像素坐标，可以确定另一组标定参数T和R，由此，可采用RANSAC的方法对标定结果进行评价，取得两组标定参数中的较优组。由于采用RANSAC的方法对标定结果进行评价已经是现有较为成熟的方法，为节约篇幅，这里不再赘述。0125为将本发明实施例进一步阐述清楚，下面以所述至少三个标定点所位于的标定物均为激光雷达为例，给出。
36、本发明实施例的优选实施方式。0126在本优选实施方式中，图2和图3分别给出了用于联合标定激光雷达和全景相机的标定参数的解算模块和解算流程。0127解算模块包括激光雷达坐标系下激光雷达几何轮廓标定点模块、模式识别标定点拟合模块、全景相机的全景图像坐标系下激光雷达几何轮廓标定点模块、标定参数解算模块、标定参数结果模块和标定结果优化模块。其中，标定参数结果模块维护多组标定参数结果。0128解算流程如下0129步骤一使用实验的方法测量多个标定点的标定内参数（XYZ），即多个标定点的激光点云坐标（LXI，LYI，LZI）。其中，标定内参数（XYZ）是在三维空间坐标系中进行标定，基于激光雷达坐标系确定标定。
37、点的实际空间位置。0130步骤二获取多个标定点的标定点参数（XY），具体地，在同步拍摄的全景图像中应用模式识别模块交互式获取对应标定点在全景图像的像素坐标（PXI，PYI）。0131步骤三将上述三维坐标（LXI，LYI，LZI）和像素坐标（PXI，PYI）的点对，三个一组作为标定参数解算模块的输入，输出激光雷达坐标系到全景相机的全景图像坐标系下的旋转矩阵和平移矩阵。0132步骤四标定结果优化。使用RANSAC方法对得到一组标定参数进行评价，得出最优标定参数。操作方法为从N个标定点中任选3个进行结算，得到组标定参数，之后将其余N3个标定参数带入到分别带入到对应的标定方程中，方差最小的被优选。01。
38、33对于不带强度的激光点云数据，由于激光点的具体位置不可见，无法与对应图像进行很好的匹配，所以此类激光雷达与全景相机的标定还没有很好的解决方案。而本发明实施例及其优选实施方式则提供了简单、精确的解决方案。说明书CN104142157A119/10页120134现有解决方案的缺点包括0135使用人工调整点云以匹配全景图像的方式，标定参数的误差难保证；0136激光点云为一组离散点，获取物体边缘多为估算值，误差较大；0137调整点云与全景图像匹配过程中，在视觉深度方向误差不可见，大大影响点云的平移矩阵精度。0138本发明实施例及其优选实施方式的优势包括0139优势1提高激光雷达的标定点参数的准确性。。
39、在全景图像中可见激光雷达的情况下，本发明采用通过激光雷达的工程设计内部参数，获取准确的激光雷达传感器外部几何所有角点相对于原点的坐标，相对于通过肉眼观察选择标定点的方式，大大提高了准确率。在全景图像中不可见激光雷达的情况下，使用精确测量得到立方体的作为标定物，可获得标定点的精确位置。0140优势2提高全景相机标定点的准确性，通过计算机模式识别技术，辅助识别全景图像上激光雷达传感器外部几何标定点的坐标或立方体标定物的标定点坐标，大大提高了全景相机标定点的准确性。0141优势3摆脱了标定场地的空间限制，由于激光源坐标系下激光点坐标（X,Y,Z）通过内部参数获得，脱离了标定场地特殊标定物的限制，全景。
40、相机的全景图像坐标系下的坐标点亦可以随时随地获得，大大提高了全景相机和激光雷达的联合标定效率。0142本发明实施例还提供一种标定装置，所述装置包括0143第一确定模块，用于对于至少三个标定点中的每个标定点，确定所述每个标定点在激光雷达坐标系下的点云坐标和在全景相机的全景图像坐标系下的像素坐标；其中，标定点位于标定物上；0144第二确定模块，用于根据所述至少三个标定点各自对应的点云坐标和像素坐标，确定用于对激光雷达和全景相机进行联合标定的标定参数。0145可见，通过确定至少三个标定点中的每个标定点的点云坐标和像素坐标，并根据所述至少三个标定点各自对应的点云坐标和像素坐标，确定用于对激光雷达和全景。
41、相机进行联合标定的标定参数，从而提供了不依赖于带有强度的激光点云数据的标定激光雷达和全景相机的方式。0146其中，标定点可以为标定物外部几何角点。0147标定物可以为激光雷达，所述第一确定模块中，所述至少三个标定点中的任一标定点在激光雷达坐标系下的点云坐标可以根据如下方式确定0148根据激光雷达工程设计参数，确定所述点云坐标。0149此外，所述第一确定模块中，对于所述至少三个标定点中的任一标定点，所述任一标定点所在的处于第一位置的第一标定物的底面与激光雷达坐标系的第一坐标轴垂直，所述第一标定物的包含所述任一标定点的第一边缘与所述第一标定物的底面垂直，且所述至少三个标定点中的任一标定点在激光雷达。
42、坐标系下的点云坐标可以根据如下方式确定0150根据激光雷达扫描所述第一标定物得到的激光点云数据，确定所述第一边缘在激光雷达坐标系的第二坐标轴上的第二坐标值和在激光雷达坐标系的第三坐标轴上的第三坐标值；0151根据所述第二坐标值、所述第三坐标值和所述任一标定点到所述底面的高度，确说明书CN104142157A1210/10页13定所述任一标定点在激光雷达坐标系下的点云坐标。0152在本发明实施例中，所述第一确定模块中，所述至少三个标定点中的任一标定点在全景相机的全景图像坐标系下的像素坐标可以根据如下方式确定0153根据全景相机拍摄所述任一标定点所在的处于第二位置的第二标定物得到的图像，确定所述任。
43、一标定点在所述图像中的第一像素；0154将所述图像中所述第一像素的坐标确定为所述任一标定点在全景相机的全景图像坐标系下的像素坐标。0155在本发明实施例中，所述标定参数可以包括激光雷达坐标系到全景相机的全景图像坐标系下的旋转矩阵和平移矩阵。0156本发明实施例还提供一种设备，所述设备包括以上所述的标定装置。0157以上所述仅是本发明实施例的实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明实施例原理的前提下，还可以作出若干改进和润饰，这些改进和润饰也应视为本发明实施例的保护范围。说明书CN104142157A131/3页14图1图2说明书附图CN104142157A142/3页15图3图4说明书附图CN104142157A153/3页16图5图6A图6B说明书附图CN104142157A16。