CN109712190A - 三维激光扫描仪与三维激光雷达的外参标定方法 - Google Patents

Abstract

本发明公开了三维激光扫描仪与三维激光雷达的外参标定方法，利用标定板，将三维激光雷达扫描落到标定板上的扫描点转移到三维激光扫描仪坐标系下，然后拾取三维激光扫描仪扫描标定板上的棋盘格角点，求取标定板平面在三维激光扫描仪坐标系下的表示，构建三维激光扫描仪坐标系下点到面的距离，优化求解得到精确的三维激光扫描仪与三维激光雷达的外参。

Description

三维激光扫描仪与三维激光雷达的外参标定方法

技术领域

本发明涉及标定方法领域，更具体的说，它涉及三维激光扫描仪与三维激光雷达的外参标定方法。

背景技术

下面的背景技术用于帮助读者理解本发明，而不能被认为是现有技术。

在我国很多冶金企业中，转炉作为重要的炼钢工具，被广泛应用。转炉的作用是负责融化由倒料斗倒入的金属矿石，将金属矿石熔炼变成金属液。但是由于在转炉的工作过程中，转炉炉腔的金属液不断腐蚀转炉炉腔，导致转炉的炉腔厚度越变越薄。当转炉炉腔厚度低于一定值后，转炉会出现“发红”，或者钢水穿炉事件，不仅损坏设备，而且严重威胁钢厂员工的人身安全。

在进行转炉炉腔三维测量时，利用低频高分辨率激光扫描仪在各个视角下扫描转炉炉腔，用高频低分辨率激光雷达感知钢厂环境，为激光扫描仪在各个扫描位置提供定位信息。为建立两个传感器(雷达和扫描仪)之间的坐标关系，需要标定得到雷达与扫描仪的外参。传统方法是通过直尺手工测量得到，雷达与扫描仪安装是基本保证只存在X，Y，Z方向的偏移，用直尺测量X，Y，Z三个方向的偏移量即可，实际安装过程中会存在X，Y，Z方向的偏移和绕三个轴的偏角，因此手工测量存在很大误差，从而会导致后期转炉炉腔三维测量不准确或失败。

发明内容

本发明的目的在于提供一种三维激光扫描仪与三维激光雷达的外参标定方法，能够得到精确的外参。

本发明解决其技术问题所采用的技术方案是：三维激光扫描仪与三维激光雷达的外参标定方法，包括以下步骤：

步骤1：将至少两个的标定板倾斜放置于三维激光扫描仪与三维激光雷达周围，每个标定板均在三维激光扫描仪和三维激光雷达的扫描范围内；

步骤2：建立三维激光雷达坐标系，三维激光雷达扫描每个标定板，拾取落到标定板上的雷达扫描点，获得雷达扫描点在三维激光雷达坐标系下的坐标值；

步骤3：建立三维激光扫描仪坐标系，假设维激光扫描仪和三维激光雷达的外参，通过外参将雷达扫描点在三维激光雷达坐标系下的坐标值转移至三维激光扫描仪坐标系下，获得雷达扫描点在三维激光扫描仪坐标系下的坐标值；

步骤4：建立标定板坐标系，三维激光扫描仪扫描标定板，选取与棋盘格标定板角点重合的扫描仪扫描点，即为扫描仪扫描角点，拾取落到标定板上的扫描仪扫描角点，获得扫描仪扫描角点在标定板坐标系下的坐标值和扫描仪扫描角点在三维激光扫描仪坐标系下的坐标值；

步骤5：根据扫描仪扫描角点在标定板坐标系下的坐标值和扫描仪扫描角点在三维激光扫描仪坐标系下的坐标值，利用坐标变换关系得到三维激光扫描仪坐标系与标定板坐标系的外参，获得每个标定板平面在三维激光扫描仪坐标系下的表示；

步骤6：根据雷达扫描点在三维激光扫描仪坐标系下的坐标值以及标定板平面在三维激光扫描仪坐标系下的表示，构建雷达扫描点到标定板平面的距离作为目标函数；

步骤7：求解三维激光扫描仪和三维激光雷达的优化外参，使得雷达扫描点到标定板平面的距离最小，

其中，为三维激光扫描仪与三维激光雷达的优化外参，为三维激光扫描仪与三维激光雷达的假设外参，D为雷达扫描点到标定板平面的距离。

本发明的优点在于：利用标定板，将三维激光雷达扫描落到标定板上的扫描点转移到三维激光扫描仪坐标系下，然后拾取三维激光扫描仪扫描标定板上的棋盘格角点，求取标定板平面在三维激光扫描仪坐标系下的表示，构建三维激光扫描仪坐标系下点到面的距离，优化求解得到精确的三维激光扫描仪与三维激光雷达的外参。

附图说明

图1为测量装置的结构示意图。

图2为三维激光扫描仪各个视角扫描转炉的示意图。

图3为三维激光扫描仪各个视角扫描转炉的测量示意图。

图4为车间环境三维点云的分层图。

图5为角点投影点所在的上一帧坐标系下的三维点云。

图6为线点投影点所在的上一帧坐标系下的三维点云。

图7为面点投影点所在的上一帧坐标系下的三维点云。

图8为角点投影点i到点j的距离示意图。

图9为线点投影点i到直线jl的距离示意图。

图10为面点投影点i到平面jlm的距离。

图11为三维激光扫描仪与三维激光雷达的相对位置关系。

图12为实际炉腔三维点云模型。

图13为坐标系Z轴对准转炉中心轴线的实际炉腔三维点云模型。

图14为实际生产转炉的内径磨损图。

图15为实际生产转炉的炉底磨损图。

图16是三维激光扫描仪、三维激光雷达和标定板的放置示意图。

图17是三维激光扫描仪、三维激光雷达和标定板的放置俯视示意图。

图18是三维激光雷达扫描标定板的示意图。

图19是三维激光扫描仪扫描标定板的示意图。

图20是标定板坐标系示意图。

图中标识：三维激光扫描仪1，三维激光雷达2，支撑杆21，推车3，手持部31，车轮32。

具体实施方式

本发明将三维激光扫描仪与三维激光雷达固定连接，在移动三维激光扫描仪的同时，通过三维激光雷达扫描钢厂车间环境，得到三维激光扫描仪在三维空间上的相对位姿，配准三维激光扫描仪各个视角下转炉炉腔的三维点云，拼接得到转炉炉腔完整的三维点云，与CAD模型对比得到转炉炉腔厚度变化，实时监测转炉炉腔的磨损情况，指明转炉需要修补的地方，判断转炉是否应该报废。

下面结合附图和具体实施方式对本发明进一步说明。

一种基于三维激光雷达辅助定位的转炉炉腔三维测量方法，包括以下步骤：

(1)保持三维激光扫描仪和三维激光雷达的相对位置不变，测量三维激光扫描仪与三维激光雷达的相对位姿，扫描仪对炉腔进行多视角扫描，获得多个视角下的炉腔三维点云。

该步骤中，将三维激光扫描仪1和三维激光雷达2均固定于能够移动的推车3上，三维激光扫描仪1和三维激光雷达2前后设置，且之间具有一定的距离，距离不限。推车3设有支撑杆21，三维激光雷达2位于支撑杆21上，三维激光雷达2高于三维激光扫描仪1。推车3具有手持部31，手持部31呈半圆环形，方便移动推车3。推车3底部设有4个车轮32，方便推车3移动，利用三维激光扫描仪1扫描炉腔的同时，三维激光雷达2扫描转炉所在的车间环境，参见图1。

本实施例中采用Riegl LMS-Z210型号的三维激光扫描仪，相比点激光发射器逐点测量转炉炉腔磨损，三维激光扫描仪极大地提高了测量效率。Riegl LMS-Z210型号的三维激光扫描仪的参数如表1所示：

表1 Riegl LMS-Z210三维激光扫描仪参数

最大测量距离	400m
		测量精度	15mm
视场角(竖直)	-55°～40°
		角度分辨率(竖直)	0.01°～0.02°
视场角(水平)	360°
		角度分辨率(水平)	0.1°～0.75°
扫描速度	0.01°/s～15°/s

本实施例采用型号为Velodyne-16的三维激光雷达，参数如表2所示：

表2 Velodyne-16三维激光雷达参数

线数	16线
		最大测量距离	100m
测量精度	±3cm
		视场角(竖直)	-15°～15°
角度分辨率(竖直)	2°
		视场角(水平)	360°
角度分辨率(水平)	0.1°～0.4°
		扫描频率	5hz～20hz

三维激光扫描仪1和三维激光雷达2的相对位置不变，作为一个具体的实施例，通过直尺测量三维激光扫描仪与三维激光雷达的相对位姿(外参)。为了获得三维激光扫描仪与三维激光雷达之间更精确的外参，作为另一个具体的实施例，对三维激光扫描仪与三维激光雷达的外参进行标定，三维激光扫描仪与三维激光雷达的外参标定方法，包括以下步骤：

步骤1：将至少两个的标定板倾斜放置于三维激光扫描仪与三维激光雷达周围，每个标定板均在三维激光扫描仪和三维激光雷达的扫描范围内。

步骤1中，标定板的个数至少为两个，保证三维激光扫描仪与三维激光雷达扫描标定板时落在标定板上的扫描点分布在多个平面上，如此，能获得扫描点的三维分布，有助于求解三维激光扫描仪与三维激光雷达的外参。本实施例中，选取两个标定板，分别标记为标定板1、标记板2，规格均为11*8*80mm。进一步，标定板之间具有一定的间距，为了保证标定板上的扫描点在空间上呈三维分布，倾斜放置是指标定板之间具有一定的夹角以及标定板均与三维激光扫描仪形成一定的夹角，这是因为如果多个标定板共面或者平行，那么标定板上的扫描点，不是分布在三维空间，而是分布在一个平面上。为了保证三维激光扫描仪和三维激光雷达能够扫描到标定板，标定板均在三维激光扫描仪和三维激光雷达的扫描范围内，如图16所示。一般将标定板放置于距离三维激光扫描仪0.5m-20m的范围内，为了获取最佳的标定效果，将标定板1、标记板2均放置于三维激光扫描仪前方1.5m处。

具体的，标定板1、标记板2具有一定的间距且相互之间具有一定的夹角，标定板1、标记板2均与三维激光扫描仪形成一定的夹角，本实施例将标定板与三维激光扫描仪形成的夹角设置为20°。如图17所示。

步骤2：建立三维激光雷达坐标系，三维激光雷达扫描每个标定板，拾取落到标定板上的雷达扫描点，获得雷达扫描点在三维激光雷达坐标系下的坐标值。

步骤2中，人工拾取落到标定板上的雷达扫描点。具体的，将标定板1、标记板2上的雷达扫描点分别记为参见图18，虚线表示雷达扫描点，由于三维激光雷达是16线激光雷达，故扫描点较为稀疏。雷达扫描点位于均位于标定板边框内。

步骤3：建立三维激光扫描仪坐标系，假设三维激光扫描仪和三维激光雷达的外参为通过外参将雷达扫描点在三维激光雷达坐标系下的坐标值转移至三维激光扫描仪坐标系下，获得雷达扫描点在三维激光扫描仪坐标系下的坐标值^SP′，获得^SP′表达式如下： ^LP表示标定板1、标定板2上雷达扫描点的集合。

步骤4：建立标定板坐标系，三维激光扫描仪扫描标定板，选取与棋盘格标定板角点重合的扫描仪扫描点，即为扫描仪扫描角点，拾取落到每个标定板上的扫描仪扫描角点，获得扫描仪扫描角点在三维激光扫描仪坐标系下的坐标值^sP(^SX,^SY,^SZ)以及扫描仪扫描角点在标定板坐标系下的坐标值^BP(^BX,^BY,^BZ)。其中，拾取方式采用人工拾取。如图19所示，虚线表示三维激光扫描仪扫描点。三维激光扫描仪扫描点非常密集，为了表示清楚，示意图画的较为稀疏。三维激光扫描仪扫描标定板落至标定板上的点有多个，拾取标定板上的扫描仪扫描角点个数为11*8个，参见图20。

步骤5：根据扫描仪扫描角点在标定板坐标系下的坐标值^BP(^BX,^BY,^BZ)和扫描仪扫描角点在三维激光扫描仪坐标系下的坐标值^SP(^SX,^SY,^SZ)，利用坐标变换关系得到三维激光扫描仪坐标系与标定板坐标系的外参表达式如下：获得每个标定板平面在三维激光扫描仪坐标系下的表示，表达式如下：AX+BY+CZ+D＝0。

步骤6：根据雷达扫描点在三维激光扫描仪坐标系下的坐标值^SP′以及每个标定板平面在三维激光扫描仪坐标系下的表示AX+BY+CZ+D＝0，构建坐标值到标定板平面的距离作为目标函数；

根据步骤5得到的标定板平面在三维激光扫描仪坐标系下的表示AX+BY+CZ+D＝0，以及三维激光雷达扫描落到标定板上的集合点^LP，经过三维激光扫描仪与三维激光雷达的外参坐标变换转到三维激光扫描仪坐标系下得到三维激光雷达扫描点在三维激光扫描仪坐标系下的坐标值^SP′，坐标值^SP′应该落在AX+BY+CZ+D＝0平面上，构建点到面的距离作为目标函数，表达式如下：

其中：P表示标定板的数量，Q：三维激光雷达扫描到标定板上点的数量。

步骤7：利用高斯牛顿法迭代优化求解假设外参使得点到面的距离D最小，表达式如下：

其中，为三维激光扫描仪与三维激光雷达的优化外参，为三维激光扫描仪与三维激光雷达的假设外参，D为雷达扫描点到标定板平面的距离。

步骤(1)中，将载有三维激光扫描仪与三维激光雷达的推车3放置于转炉炉口附近。本实施例中，由于炉口温度是2000度高温，无法距离太近，而距离远，则扫描仪扫到的点云会变少，所以将推车放置于距离转炉炉口1.5m的位置。选取5个视角对炉腔进行扫描，获得5个视角下的炉腔三维点云。之所以选取五个视角，由于炉口较小，无法通过一次扫描得到完整的炉腔三维形貌，必须在多个视角下对炉腔进行多次扫描。如图2和3所示，所述的5个视角分别包括左、右、中、上、下，即分别在炉口左、右、中的位置，在中的位置时，转炉分别向上转动、向下转动一定角度，转动角度可根据需要设置，只要能保证5个视角下的三维点云可以合并成完整的炉腔三维模型。本实施例中，转动角度设置为30°。

步骤(1)中，对三维激光扫描仪得到的多个视角的炉腔三维点云进行去噪处理。由于扫描仪在扫描转炉炉腔的同时，会扫描到环境，产生大量额外点云。本实施例中，去噪处理的方法为：建立三维激光扫描仪的坐标系，计算每个点到扫描仪坐标原点的距离，距离表达式如下：

设定阈值T_D，如果D＞＝T_D，则将该点移除。

当距离大于距离阈值T_Δ时，则认为该点位额外点云，对这部分点云进行去除，保留下的点云为下一步的点云配准做准备。

(2)同时，三维激光雷达扫描车间环境，采集多帧车间环境的三维点云。

该步骤中，在三维激光扫描仪对炉腔进行多视角扫描的同时，三维激光雷达扫描转炉所在的车间环境，采集多帧车间环境的三维点云。具体的，三维激光雷达的扫描频率设置为10HZ。在车间环境中，由于工人的走动，会对三维激光雷达扫描产生动态干扰，因此，需要去除动态干扰三维点云。

本实施例中，去除动态干扰三维点云的方法为：在三维激光雷达坐标系下；然后计算车间环境的三维点云与三维激光雷达坐标系的距离；最后设定去除距离，直接将去除距离内的三维点云移除。具体的，去除距离设置为5m。

其中，三维激光雷达坐标系满足右手螺旋定则，X轴在三维激光雷达坐标系正前方，Z轴垂直向上，Y轴根据右手定则得到。其中，三维激光雷达扫描的车间环境三维点云与三维激光雷达坐标系的距离表达式如下：

式中，x,y,z分别为三维激光雷达坐标系下点的坐标系，D为三维激光雷达扫描的车间环境三维点云与三维激光雷达坐标系的距离。

如果D≤5m，则判断为动态干扰点云，将该范围内的三维点云全部移除。

(3)提取各帧车间环境三维点云的特征点、线特征点和面特征点，对相邻两帧之间分别进行特征点、线特征点和面特征点匹配。

步骤(3)中，提取各帧车间环境三维点云的特征点、线特征点和面特征点，对相邻两帧之间分别进行特征点、线特征点和面特征点进行匹配。

其中，提取各帧车间环境三维点云特征点的方法包括以下步骤：

(3.1)根据采集的车间环境三维点云，获取车间环境三维点云的坐标信息和强度信息。

(3.2)根据车间环境三维点云的坐标信息和强度信息，利用HarrisKeypoint 2D函数，提取各帧车间环境三维点云中的Harris角点H；根据钢厂车间的条件，点的强度信息区别较明显，故根据点云的强度信息提取Harris角点H，具体的，根据车间实际工况，设置阈值，约提取300个Harris角点。

提取各帧车间环境三维点云的线特征点、面特征点的方法，包括以下步骤：

(3.11)根据车间环境三维点云，对车间环境三维点云进行分层，得到多层点云；

(3.12)计算每层点云中每个点的特征值；

(3.13)计算每层点云中每个点的特征值的方差，设定阈值，去除方差小于阈值的点云层；

(3.14)根据各帧每层点云中的每个点的特征值，提取各帧每层点云中的线点、次线点、面点和次面点，线点和次线点均为线特征点，面点和次面点均为面特征点。

具体的，步骤(3.11)中，对车间环境三维点云进行分层包括以下步骤：首先根据三维激光雷达坐标系确定三维激光雷达的俯仰角度；然后对俯仰角度进行分层；最后去除俯仰角度范围之外的车间环境三维点云。

其中，式中，x,y,z分别为三维激光雷达坐标系下点的坐标系。

雷达的俯仰角度为-15°～15°，每2°一根线，共16根线，根据θ＝{-15°，-13°，-11°……11°，13°，15°}，将车间环境的三维点云分为16层。将θ≥15°或者θ≤-15°的错误测量点直接去除。得到的点云图如图4所示。

具体的，步骤(3.12)中，首先从每层点云的第6个点开始，到每层倒数第6个点为止，逐个计算每个点的特征值，计算点的特征值的方法为：计算每个点与左右各5个点在X、Y、Z三个方向上的差值平方的和，如下式所示：

Δ_i＝(Δ_ix)²+(Δ_iy)²+(Δ_iz)²

式中，i为待求点，j为待求点左右的点。

步骤(3.13)中，方差的表达式如下：

式中，N为每层点的数量，表示特征值的均值，σ²为方差。

本实施例中，将阈值设为T_Δ。如果方差较小，说明点的特征值区分度不大，之后会根据点的特征值提取线点和面点，如果特征值的方差较小，从而会导致线点和面点的特征值区别不大，影响后期相邻两帧点云中特征点的关联。

步骤(3.14)中，首先将每层点云按照角度平均分成6部分，每部分为60°，本实施例中，每部分点的数量大约为600个，将每层点云按照角度平均分成6部分的目的是保证特征点均匀分布。然后根据点的特征值的大小提取线点、次线点、面点和次面点，线点、次线点、面点和次面点的提取个数依据实际情况而定。本实施例中，取特征值最大的前2个点为线点E，取特征值最大的前10个点为次线点取特征值最小的后6个点为面点P，取特征值最小的后30个点为次面点

提取特征点、线特征点、面特征点之后，分别对相邻两帧之间的特征点、线特征点和面特征点进行匹配。

步骤(3)中，进行特征匹配的过程为：选取当前帧和上一帧坐标系下的三维点云，分别寻找当前帧Harris角点、线点和面点在上一帧中的投影点，Harris角点即为特征点，线点和次线点即为线特征点，面点和次面点即为面特征点。

具体的，相邻两帧车间环境三维点云的Harris角点H进行匹配的方法为：

假设L_k+1：当前帧K+1车间环境三维点云的坐标系，L_k：上一帧K车间环境三维点云的坐标系，两帧坐标系之间的变换矩阵为将L_k+1坐标系下的Harris角点H_(k+1)经过T变换投影到L_k坐标系，得到 为相对位姿变换，T的初值旋转部分R设为单位阵，平移部分t设为0。如图5所示，三角形点i为L_k+1坐标系下H_(k+1,i)在L_k坐标系下的投影点其中，根据两帧坐标系的相对位姿关系T(R,t)将当前帧K+1点云坐标系下的角点投影到上一帧K点云坐标系下的表达式如下：

式中，H_(k+1,i)为当前帧K+1坐标系下角点的坐标，为当前帧K+1坐标系下角点根据两帧相对位姿关系T(R,t)投影到上一帧K坐标系下的坐标，T(R,t)为相对位姿变换，T的初值旋转部分R设为单位阵，平移部分t设为0。

步骤(3)中，具体的，相邻两帧车间环境三维点云的线特征点进行匹配的方法为：

假设L_k+1：当前帧K+1的坐标系，L_k：上一帧K坐标系，两帧坐标系之间的变换矩阵为将L_k+1坐标系下的线点E_(k+1)经过T变换投影到L_k坐标系，得到 为相对位姿变换，T的初值旋转部分R设为单位阵，平移部分t设为0。如图6所示，三角形点i为L_k+1坐标系下E_(k+1,i)在L_k坐标系下的投影点其中，将当前帧K+1点云坐标系下的线点根据两帧坐标系的相对关系T(R,t)投影到上一帧K点云坐标系下的表达式如下：

式中，E_(k+1,i)为当前帧K+1坐标系下线点的坐标，为当前帧K+1坐标系下线点根据两帧相对位姿关系T(R,t)投影到上一帧K坐标系下的坐标，T(R,t)为相对位姿变换，T的初值旋转部分R设为单位阵，平移部分t设为0。

步骤(3)中，具体的，相邻两帧车间环境三维点云的面特征点进行匹配的方法为：

假设L_k+1：当前帧K+1的坐标系，L_k：上一帧K坐标系，两帧坐标系之间的变换矩阵为将L_k+1坐标系下的面点P_(k+1)经过T变换投影到L_k坐标系，得到 为相对位姿变换，T的初值旋转部分R设为单位阵，平移部分t设为0。如图7所示，三角形点i为L_k+1坐标系下的P_(k+1,i)在L_k坐标系下的投影点其中，将当前帧K+1点云坐标系下的面点根据两帧坐标系的相对关系T(R,t)投影到上一帧K点云坐标系下的表达式如下：

式中，P_(k+1,i)为当前帧K+1坐标系下面点的坐标，为当前帧K+1坐标系下面点根据两帧相对位姿关系T(R,t)投影到上一帧K坐标系下的坐标，T(R,t)为相对位姿变换，T的初值旋转部分R设为单位阵，平移部分t设为0。

步骤(4)，建立以相邻两帧匹配程度最高为目标的目标函数，确定目标函数的权重参数，利用高斯牛顿迭代求解目标函数，得到相邻两帧之间三维激光雷达的位姿变换。相邻两帧匹配程度最高是指相邻两帧的角点、线点和面点匹配程度最高。

步骤(4)中，建立以相邻两帧匹配程度最高为目标的目标函数的方法，包括以下步骤：

(4.1)假设L_k+1：当前帧K+1的坐标系，L_k：上一帧K坐标系，两帧坐标系之间的变换矩阵为

(4.2)如图5所示，圆点为上一帧L_k坐标系的Harris角点在L_k坐标系的角点中找三角形点的最近点j，记作如图8所示，点i到j的距离为d_H，表达式如下：

(4.3)如图6所示，圆点为上一帧L_k坐标系的次线点在L_k坐标系的次线点中寻找距离三角形点的最近点即第一近线点j，记作在j点的上一层点云或者下一层点云中找第一近线点j点的最近点即第二近线点l，记作如图9所示，以上一帧K的第一近线点与第二近线点构成直线，求解线点投影点到直线jl的最小距离，表达式如下：

式中，d_E：点i到直线jl的距离； 三角形Δ_ijl面积的二倍；直线jl的长度。

(4.4)如图7，圆点为上一帧L_k坐标系的次面点在L_k坐标系的次面点中寻找距离面点投影点的最近点j即第一近面点，记作在j点的上一层点云或者下一层点云中寻找距离第一近面点j的最近点l即第二近面点，记作在与j点同一层点云中寻找j点的最近点m即第三近面点，记作其中，i、j、m均为次面点；如图10所示，第一近面点j、第二近面点l和第三近面点m构成平面jlm，求解面点投影点i与平面jlm的距离，表达式如下：

式中，d_P为点i到平面jlm的距离； 为三角体Δ_jlm体积的二倍；为三角形Δ_jlm面积的二倍。

(4.5)对当前帧L_k+1坐标系下的所有线点E，面点P，Harris角点H，在上一帧K三维激光雷达点云L_k中相应地寻找Harris角点投影点、线点投影点、面点投影点，分别构建上一帧K坐标系下的角点投影点到点、线点投影点到线、面点投影点到面的距离(d_E,d_P,d_H)的加权和作为目标函数D，表达式如下：

D＝w_ED_E+w_PD_P+w_HD_H

式中，N_H：Harris角点的个数，N_E：线点的个数，N_P：面点的个数；w_E,w_P,w_H：表示线点、面点、Harris点的权重；相对位姿变换。权重参数可以根据具体情况进行调节，本实施例中，此处的权重设置为w_E＝0.4,w_P＝0.3,w_H＝0.3。

其中：目标函数D是关于的函数，故上式可改写为：

式中，N：点的数量，包括角点、线点和面点；X_(k+1,i)：点i在k+1帧的坐标；i：点的序号；相对位姿变换。

具体的，步骤(4)中，利用高斯牛顿迭代求解目标函数。利用高斯牛顿法即可求解 为K+1帧与K帧之间三维激光雷达的位姿变换。若两帧之间的相对位姿变换较为准确，D趋近于0，通过高斯牛顿法迭代求解目标函数，可得到准确的

(5)将所有帧的位姿变换累计相乘，获得三维激光雷达的相对位姿，根据步骤(1)中三维激光扫描仪与三维激光雷达的相对位姿，得到三维激光扫描仪在各个视角下的相对位姿。

通过将所有帧的位姿变换累计相乘，获得三维激光雷达的相对位姿，即三维激光雷达的运动轨迹。以第一帧车间环境三维点云的坐标系为世界坐标系，通过相邻两帧之间的相对位姿变换，累计相乘得到三维激光雷达第K帧的坐标系为：

式中，表示相邻两帧之间三维激光雷达的相对位姿变换，k＝1，2，3··。

如图11所示，圆点代表三维激光雷达的位姿，黑色线条代表三维激光雷达的运动轨迹，五角星表示三维激光扫描仪的左右中视角的位置。由于三维激光扫描仪与三维激光雷达固定在一起，故三维激光雷达的相对位置变换与三维激光扫描仪的相对位姿满足如下关系：

式中，左视角下三维激光扫描仪坐标系在中视角三维激光扫描仪坐标系下的相对位姿，左视角三维激光雷达坐标相对于中视角下的三维激光雷达坐标的位姿变换；

右视角下三维激光扫描仪坐标系在中视角三维激光扫描仪坐标系下的相对位姿；右视角三维激光雷达坐标相对于中视角下的三维激光雷达坐标的位姿变换；

通过直尺测量得到的三维激光雷达与三维激光扫描仪的相对位姿。三维激光雷达与三维激光扫描仪的相对位姿是指X、Y、Z三个方向的相对平移和相对旋转，一般三维激光雷达与三维激光扫描仪之间的相对旋转基本为0，即只需测量三个方向的平移；

的逆。

(6)根据三维激光扫描仪在各个视角下的相对位姿，利用ICP算法对多个视角下的炉腔三维点云精配准，拼接得到完整的实际炉腔三维点云。

该步骤中，利用去噪后的各个视角下的点云，利用三维激光雷达扫描得到的三维点云，进行帧间匹配得到左视角、中视角、右视角下三维激光雷达的相对位置。左视角三维激光雷达坐标相对于中视角下的三维激光雷达坐标的位姿变换，右视角三维激光雷达坐标相对于中视角下的三维激光雷达坐标的位姿变换。通过直尺测量或外参标定得到三维激光雷达与三维激光扫描仪的相对位姿通过坐标变换得到左视角下三维激光扫描仪坐标系在中视角三维激光扫描仪坐标系下的相对位置关系：同理可得右视角下三维激光扫描仪坐标系在中视角激光扫描仪坐标系下的相对位置关系：

上下视角相对于中视角的相对位姿可由编码器测量得到。上下左右中五个视角的相对位姿即可得到，将该相对位姿作为初值，通过ICP精配准，配准“上”，“下”，“左”，“右”，“中”，五个视角下扫描仪扫描转炉炉腔的点云，得到炉腔完整的点云模型。配准效果如图12所示。

(7)获取原始炉腔三维点云，对比实际炉腔三维点云和原始炉腔三维点云，得到转炉损耗情况。

该步骤中，根据实际炉腔三维点云，采用随机采样一致性(RANSAC)算法，提取转炉的圆柱部分，得到转炉的中心轴线，转换坐标系，使得坐标系Z轴对准转炉中心轴线。

该步骤中，获取原始炉腔三维点云的方法是：利用solidworks软件建立转炉三维模型，将转炉三维模型倒入Blender扫描软件中，得到转炉CAD模型的三维点云。采用RANSAC算法，提取转炉CAD模型的三维点云的圆柱部分，得到圆柱部分的中心轴线，将轴线与Z轴对准，如图13所示。将实际炉腔三维点云与原始炉腔三维点云从XYZ坐标系转换为柱坐标系(Z,θ,r)，

Z＝Z；

根据实际炉腔三维点云和原始炉腔三维点云，对比得到转炉内径磨损图和炉底磨损图，如图14和图15所示，其中内径磨损图横坐标表示θ，纵坐标表示Z，图的颜色深浅表示炉腔的实际三维点云与CAD模型点云半径的差值。炉底磨损图横坐标表示X，纵坐标表示Y，图的深浅表示炉腔的实际测量点云与CAD模型点云Z值的差值。其中颜色较浅的区域磨损较为严重。

本测量方法可以在不添加额外复制标志的情况下，实现三维激光扫描仪快速，准确的定位，利用三维激光扫描仪可以得到转炉炉腔的三维信息，相比点激光发射器，逐点测量转炉炉腔磨损，三维激光扫描仪极大的提高了测量效率。本方法及装置能够更准确的对转炉炉腔磨损情况进行评价，保证设备安全生产，为钢厂工人师傅及时修补转炉提供理论支撑，提高转炉炉役时间，提高效率和利润。

本说明书实施例所述的内容仅仅是对发明构思的实现形式的列举，本发明的保护范围不应当被视为仅限于实施例所陈述的具体形式，本发明的保护范围也及于本领域技术人员根据本发明构思所能够想到的等同技术手段。

Claims (3)

1.三维激光扫描仪与三维激光雷达的外参标定方法，包括以下步骤：步骤1：将至少两个的标定板倾斜放置于三维激光扫描仪与三维激光雷达周围，每个标定板均在三维激光扫描仪和三维激光雷达的扫描范围内；

步骤2：建立三维激光雷达坐标系，三维激光雷达扫描每个标定板，拾取落到标定板上的雷达扫描点，获得雷达扫描点在三维激光雷达坐标系下的坐标值；

步骤3：建立三维激光扫描仪坐标系，假设维激光扫描仪和三维激光雷达的外参，通过外参将雷达扫描点在三维激光雷达坐标系下的坐标值转移至三维激光扫描仪坐标系下，获得雷达扫描点在三维激光扫描仪坐标系下的坐标值；

步骤4：建立标定板坐标系，三维激光扫描仪扫描标定板，选取与棋盘格标定板角点重合的扫描仪扫描点，即为扫描仪扫描角点，拾取落到标定板上的扫描仪扫描角点，获得扫描仪扫描角点在标定板坐标系下的坐标值和扫描仪扫描角点在三维激光扫描仪坐标系下的坐标值；

步骤5：根据扫描仪扫描角点在标定板坐标系下的坐标值和扫描仪扫描角点在三维激光扫描仪坐标系下的坐标值，利用坐标变换关系得到三维激光扫描仪坐标系与标定板坐标系的外参，获得每个标定板平面在三维激光扫描仪坐标系下的表示；

步骤6：根据雷达扫描点在三维激光扫描仪坐标系下的坐标值以及标定板平面在三维激光扫描仪坐标系下的表示，构建雷达扫描点到标定板平面的距离作为目标函数；

步骤7：求解三维激光扫描仪和三维激光雷达的优化外参，使得雷达扫描点到标定板平面的距离最小，

其中，为三维激光扫描仪与三维激光雷达的优化外参，为三维激光扫描仪与三维激光雷达的假设外参，D为雷达扫描点到标定板平面的距离。

2.如权利要求1所述的三维激光扫描仪与三维激光雷达的外参标定方法，其特征在于：标定板的个数设置为两个。

3.如权利要求2所述的三维激光扫描仪与三维激光雷达的外参标定方法，其特征在于：采用高斯牛顿法求解假设外参