本文内容来源于《测绘学报》2023年第9期（审图号GS京(2023)1783号）

LiDAR标签和栅格占有图结合的LiDAR/IMU空间标定方法钱闯1, 张红娟2,3, 李文卓2, 刘晖4, 李必军2,31. 武汉理工大学智能交通系统研究中心, 湖北 武汉 430063;

2. 武汉大学测绘遥感信息工程国家重点实验室, 湖北 武汉 430079;

3. 武汉大学时空数据智能获取技术与应用教育部工程研究中心, 湖北 武汉 430079;

4. 武汉大学卫星导航定位技术研究中心, 湖北 武汉 430079基金项目：国家重点研发计划(2021YFB2501100)摘要：LiDAR和惯性测量单元(inertial measurement unit, IMU)在智能汽车获得了广泛的应用, 比如高精度地图构建、车辆实时定位等。两种传感器进行组合测量时, 需要知道两者之间的空间关系, 包括空间旋转和平移参数。本文提出了一种基于LiDAR标签的自动化LiDAR/IMU空间标定方法。首先分析了LiDAR/IMU标定参数对LiDAR点云拼接的影响, 证明了当车辆近似直线运动时, 使用概略标定参数即可利用IMU的姿态信息将LiDAR点云转换到轴向近乎一致的坐标系。基于该结论, 提出了一种基于IMU姿态约束的LiDAR栅格占有图构建方法, 构建高相对精度的点云地图与LiDAR标签的点云进行地图匹配, 获得LiDAR标签在图中的位置, 相对于单点云帧互匹配方法, 提高标签点云匹配的精度和可靠性。然后基于LiDAR标签的已知高精度位置, 采用非线性优化方法解算栅格占有图与LiDAR标签的空间转换关系, 进而求解LiDAR/IMU的空间标定参数。试验结果表明, 利用本文方法获得的标定参数构建的点云地图, 可实现厘米级的绝对位置精度, 验证了本文方法的正确性和可行性。关键词：空间标定 激光雷达 惯性测量单元 激光雷达标签 引文格式：钱闯, 张红娟, 李文卓, 等. LiDAR标签和栅格占有图结合的LiDAR/IMU空间标定方法[J]. 测绘学报，2023，52(9)：1469-1479. DOI: 10.11947/j.AGCS.2023.20220242QIAN Chuang, ZHANG Hongjuan, LI Wenzhuo, et al. A LiDAR/IMU spatial calibration method based on LiDAR labels and occupancy grid map[J]. Acta Geodaetica et Cartographica Sinica, 2023, 52(9): 1469-1479. DOI: 10.11947/j.AGCS.2023.20220242 阅读全文：引 言随着自动驾驶技术的发展，LiDAR和惯性测量单元(inertial measurement unit, IMU)已经成为自动驾驶汽车必不可少的两类传感器。利用LiDAR和IMU数据融合可实现车辆精准定位[1-2]、高精度地图构建[3-4]、目标识别与分类[5-6]等应用，但是前提是需要知道准确的LiDAR和IMU的空间转换关系，也称为LiDAR/IMU空间标定参数[7-8]。传感器坐标系一般位于传感器测量元件中心位置，难以给出标定参数精确的手工测量值，因此一般是通过标定算法对LiDAR和IMU的空间相对关系进行离线或在线标定。LiDAR和IMU空间标定方法主要可分3类：手眼标定、在线标定方法和标签标定法。手眼标定使用LiDAR帧间匹配(scan-to-scan matching)技术得到LiDAR两个连续时刻间相对位置姿态。同时，IMU机械编排可计算IMU两个连续时刻间相对位置姿态[9]。通过两个传感器的外参参数可构造两者的相对运动约束，构建观测方程，非线性求解外参参数。为了使法方程满秩，需要3个以上不同方向上的相对运动。文献[10]将LiDAR/IMU外参数标定转化为手眼标定问题实现系统标定，在此基础上，提出了一种基于因子图优化的LiDAR/IMU紧组合定位方法。文献[11]提出了一种由粗到精的自适应能力强的LiDAR/IMU外参数标定算法，采用手眼标定算法对LiDAR/IMU外参数进行初步求解，结合使用IMU运动估计，计算点云重投影误差，构建联合优化函数，迭代计算得到精确的外参数。文献[12]利用高精度地图对LiDAR/IMU进行手眼标定，LiDAR点云和高精度地图实时匹配获得运行轨迹，通过标定参数将其与IMU的轨迹进行坐标转换，构建约束方程并求解标定参数。文献[13]提出了一种通用的基于传感器间相互运动约束的手眼标定框架，适用于LiDAR/相机/IMU传感器之间的相互标定。手眼标定算法不依赖于传感器外参数初始值精度，但是IMU机械编排受器件零偏误差的影响，LiDAR帧间匹配精度有限，导致标定精度不高。同时，手眼标定算法需要传感器有充分的机动才能保证标定参数的可观性。LiDAR/IMU在线标定通常在LiDAR/IMU融合里程计或SLAM系统中将待标定的外参参数加入到状态估计方程进行在线估计。文献[14]为了提高LiDAR/IMU在线标定的实时性，提取LiDAR点云中的平面特征并对前后帧进行数据关联，利用多状态约束Kalman滤波器将LiDAR/IMU外参数引入到状态量进行实时解算。文献[15—16]提出了一种基于滑动窗口滤波器的在线空间校准方法，为了提高LiDAR点云中平面特征提取和跟踪的效率与可靠性，提取低曲率平面点并在滑动窗口中进行跟踪，利用异常值探测实现高质量数据关联。文献[17]利用IMU预积分补偿高速环境下LiDAR点云的运动畸变，提高基于平面特征的LIDAR/IMU外参标定精度。文献[18]提出一种用于地下空间恶劣环境的LiDAR/IMU导航器，为满足野外环境下传感器随装随用的性能，该导航器还采用滑动窗口滤波器对LiDAR/IMU外参进行在线估计，但LiDAR点云特征提取采用的是点特征而不是平面特征。文献[19]提出了一种基于多特征(点/球、线/柱、平面特征)的在线LiDAR/IMU标定方法，并同时在线标定LiDAR内参、IMU内参和LiDAR/IMU外参。在线标定方法有效解决了传感器安装位置发生变化时需要重新标定的问题，具有实时性和自主调整能力，但是标定效率依赖于算法的收敛速度，且将标定参数加入待估参数会降低系统的可靠性，当载体的机动不足导致标定参数的可观性降低时，可能会出现错误的估计结果。同时，在线标定方法需要有一个较高精度的标定参数初值才能较快地收敛，这也对离线标定提出了更高的要求。标签标定法利用特定的人工目标或特定设施，通过第三方精密仪器(通常是全站仪)测量标签的精确全局位置，建立标签在全局坐标系、LiDAR坐标系和IMU坐标系下的位姿传递方程，求解标定参数。文献[20]设计了一种使用角反射器作标志物的标定方法，通过区域分割、地面滤除和标志点提取的预处理方法来提取标志点，使用迭代最近邻点算法求得标志点在LiDAR下的坐标，对IMU和LiDAR坐标系下的标志点数据进行数据拟合，求得标定参数。文献[21]通过提取人工制作的锥形圆柱筒的几何特征来建立LiDAR和IMU的坐标转换关系，利用扩展卡尔曼滤波对标定参数进行优化。文献[22]采用在建筑物面布设人工标签，通过全站仪获得标签坐标，并从点云中提取标签坐标，利用最小二乘求解标定参数。标签标定法简便且可靠，但是其标签的布设、测量、维护与提取过程较为复杂，影响标定的效率。综上所述，标签标定法可以通过标签布设保证标定参数的可观性，从而实现标定参数的可靠解算，也可为在线标定等方法提供高精度的标定参数初值。因此，本文设计一种基于LiDAR标签的LiDAR/IMU空间标定方法，利用组合导航获取IMU的高精度位置和姿态信息，采用标定参数初始值和IMU姿态约束构建LiDAR栅格占有地图，基于地图匹配方法获得LiDAR标签在图中的位置，最终通过LiDAR标签的已知高精度位置实现标定参数的最优估计。1 方法LiDAR/IMU外参标定流程如图 1所示。首先通过车载GNSS和IMU进行组合导航计算所有时刻的IMU在“东-北-天”导航系下的位置和姿态。然后利用标定参数初始值和IMU组合导航数据进行姿态约束的LiDAR里程计解算，生成近似导航系下的栅格占有地图。最后将LiDAR标签获取的点云与栅格地图进行匹配，基于LiDAR标签的已知位置，利用非线性优化算法求解LiDAR/IMU外参数。本文构建LiDAR栅格占有图而后将标签点云与地图匹配，而非采用文献[23—24]中某一时刻的点云帧与标签点云匹配，一方面是为了提高匹配精度，另一方面后者需要标签布设在待标定的LiDAR附近，极大限制了标签的空间分布，加大了布设难度。本文采用的LiDAR的采样频率为20 Hz，IMU的采样频率为600 Hz，为实现数据同步，以LiDAR时间点为基准，将IMU组合导航结果线性插值到LiDAR时刻。

图 1 LiDAR/IMU外参标定流程Fig. 1 Flowchart of LiDAR/IMU calibration图选项

本文涉及的坐标系如下。LiDAR坐标系(l系)：LiDAR坐标系原点位于雷达内部，定义为l系，Y轴正方向指向雷达自转的旋转角0°方向，Z轴指向自转轴向上，X轴垂直于Y与Z轴，构成右手直角坐标系。IMU坐标系(b系)：IMU坐标系原点通常位于IMU中心，定义为b系，是加速度计和陀螺仪测量输出值定义的坐标系，X、Y和Z轴通常采用“前右下”或“右前上”，构成右手直角坐标系。导航坐标系(n系)：导航系以第一帧的IMU坐标为坐标系原点，Z轴与椭球法线重合，向上为正(天向)，Y轴与椭球短半轴重合(北向)，X轴与地球椭球的长半轴重合(东向)所构成的直角坐标系。各坐标系的转换关系如下。(1) b系到n系的空间转换如下 (1)式中，φ、θ、γ分别为航向角、俯仰角和横滚角；[xbybzb]T为待转换点在b系下的坐标；Cbn为b系到n系的方向余弦矩阵；[XEYNZU]T为车辆在导航坐标系下的坐标。(2) l系到n系的空间转换如下 (2)式中，[xlylzl]T为待转换点在l系下的坐标；旋转矩阵Clb和杆臂Tlb即为LiDAR与IMU之间待标定的安装参数。GNSS与IMU间的安装参数为两者杆臂lGNSSIMU，即GNSS天线相位中心相对于IMU坐标系的三维坐标，可采用全站仪进行精密测量。下面将对图 1灰色框中方法进行详细介绍。

1.1 GNSS/IMU组合导航

GNSS和IMU组合可利用两种传感器提供的互补信息来提高导航系统的精度和可靠度。本文采用基于扩展卡尔曼滤波(extended Kalman filter, EKF)的GNSS/IMU松组合模型对GNSS定位观测和IMU观测进行融合。首先基于IMU机械编排构建状态误差方程如下 (3)式中，状态误差量δx包括n系下的姿态误差ϕ =[ϕEϕNϕU]T、速度误差δvn=[δvEδvNδvU]T、位置误差δr=[δXEδYNδZU]T、陀螺仪零偏误差bg=[bgx bgy bgz]T和加速度计零偏误差ba=[bax bay baz]T，一共为15维状态量；Φk+1/k为状态转移矩阵；wk为驱动白噪声。将GNSS-RTK(GNSS real time kinematic)解算的位置与IMU机械编排解算的位置作差，作为EKF的观测量，并构建EKF观测方程如下 (4)式中，Hk为状态量系数阵；I为单位阵；vk为观测噪声；O为零矩阵。进一步构造EKF状态更新方程如下 (5)式中，Pk为状态误差协方差阵；δxk-为δxk的预测值；Pk-为Pk的预测值；Gk为卡尔曼增益。 (6)式中，Rk为观测误差协方差阵。最终，将状态误差量δxk反馈给IMU机械编排的状态量预测值xk-=[Cbn-, vkn-, rkn-, bg-, ba-]，得到k时刻的状态量如式(7)所示 (7)

1.2 基于组合导航结果的LiDAR点云拼接

基于GNSS/IMU组合导航获得每个时刻IMU的高精度位置姿态后，可通过LiDAR/IMU的标定参数(注意，此处假设标定参数准确)，获得LiDAR在n系下的高精度位置姿态，将其作为空间基准将每一帧点云在n系下拼接为点云地图。通过IMU的位姿计算LiDAR在t时刻在n系下的位姿(Ct,ln, rt,LiDARn) (8)然后，将t时刻的激光扫描帧St中的激光点x∈St从l系转换到n系，公式如下 (9)式中，xt,l为激光点在l系中的三维位置；rt,xn为激光点在n系中的三维位置。对每一帧点云按照式(9)进行坐标转换，即可获得n系下的点云地图。但是，式(8)和式(9)假设了LiDAR/IMU标定参数不存在误差。当把标定参数的初始值代入式(8)时 (10)式中，Clb′和Tlb′为标定参数的初始值。从Ct,ln′可看出，LiDAR点云并不是转到真正n系，而是转到了一个与n系有一定角度偏差的n′系。当考虑标定参数误差时，式(8)和式(10)可改写为 (11)将Cb′b记为Cϕ，被认为是标定参数旋转角误差，将Tb′b记为Tδr，被认为是标定参数杆臂误差。利用式(10)和式(11)计算t时刻n′系与n系的夹角Ct,n′n (12)计算t=1和t=i时刻对应的n′系的夹角C1,n′i,n′ (13)当车辆沿着直线行驶时，车辆朝向基本保持不变，则中间项(Cni,bC1,bn)接近单位阵，初始标定参数的误差为小角度误差，Cϕ接近单位阵，式(13)即为Cϕ的二次项，根据误差扰动规律，小角度误差的二次项可以忽略不计。因此可以认为C1,n′i,n′近似为单位阵，即任意时刻的n′系是平行的，构建的点云地图不会扭转。接下来分析标定参数杆臂误差Tδr，计算t=1和t=i时刻对应的n′系的位移T1,n′i,n′ (14)式中，Δrin′为i时刻IMU与起始位置在n′系下的相对位置。随着车辆直线运行，Δrin′会逐渐增大，因此(Cn′n- I)Δrin′也会逐渐增大。由于Ci, bn与C1,bn相似，且Tδr也较小，因此(Ci, bn- C1,bn)Tδr项很小，可忽略。总体而言，i时刻的n′系与第1时刻的n′系虽然轴向近似一致，但是存在不可忽略的偏移T1,n′i,n′，并且偏移主要受(Cn′n-I)Δrin′影响，会随车辆轨迹增加而逐渐增大。因此，当LiDAR/IMU标定参数存在误差时，由于不同时刻的点云帧转到n′系时位置会有偏移，直接利用IMU位姿对点云进行拼接，会产生点云的重影问题。

1.3 姿态约束的LiDAR栅格占有图

1.2节已经证明，在车辆近似直线运动下，点云转换后的坐标系轴向是一致的，但是点云帧之间的位置变化不能直接使用IMU的组合导航位姿结果。因此，为了解决LiDAR/IMU标定参数误差导致的点云拼接地图中的重影问题，本文提出了一种姿态约束的LiDAR SLAM方法构建三维栅格占有图，充分利用IMU姿态的约束信息，提高地图的相对精度[25]，同时解决地图拼接的重影问题。三维栅格占有图是将三维空间按照2 cm的空间分辨率划分为三维格网，每个栅格的初始占有概率设为0.01。输入每一帧的LiDAR点云时，基于最大似然估计方法(maximum likelihood estimation，MLE)统计每个激光脚点落在某个栅格内的概率。随着点云的输入，不断对栅格的占有概率进行更新，最终生成全局的栅格占有图。MLE是一种scan-to-map的点云匹配方法，可以消除帧间匹配带来的累计误差。基于贝叶斯理论，假设点云之间相互独立，t时刻的激光扫描帧St与上一时刻的栅格占有图Mt-1之间的似然值如式(15)所示 (15)式中，P(x|Mt-1)为激光点x∈St落在Mt-1中的概率。由于LiDAR一直在运动，对应的激光雷达坐标系l系也随时间变化，为了实现式(15)，需要将St与Mt-1统一到同一个坐标框架下，同时保证P(St|Mt-1)最大，如式(16)所示 (16)式中，R ∝St为经过可能的坐标转换R后的扫描帧。从式(16)可看出，MLE方法涉及了两个关键步骤：①从t=1时刻到t-1时刻的栅格占有图Mt-1；②获取t时刻的LiDAR与Mt-1的坐标转换关系R*。对于上述问题①，首先需确定栅格占有图的空间基准。依据式(10)，通过IMU的组合导航结果Ct,bn、rt,IMUn和LiDAR/IMU标定参数初始值Clb′和Tlb′，可获得t时刻LiDAR在n′系下的绝对位置和姿态。从1.2节可看出，任意时刻的n′系可看作是平行的，因此，将第一个时刻LiDAR在n′系中的位置和姿态作为栅格占有图的空间基准。针对上述问题②，采用高斯-牛顿法解算式(16)中的R*。高斯-牛顿法的基本思想是给定式(16)中的R一个初始值R0，寻找一个ΔR来配准St与Mt-1，如式(17)所示 (17)对式(17)进行一阶泰勒展开，将其代入到最小二乘问题中并关于ΔR求导，令导数为0可得到高斯-牛顿方程 (18)式中，H为二阶海森矩阵；S为扫描点的距离测量值。不断迭代上面的增量方程求解ΔR，若ΔR足够小，则停止；否则令Rt+1= Rt+ΔRt，返回式(18)。一般来说，R包括姿态增量和位置增量，本文已证明任意时刻LiDAR在n′系的姿态与第一帧的姿态相同，故本文只对位置进行增量求解。将式(10)中LiDAR的位置r0,t,LiDARn′作为t时刻高斯-牛顿迭代法的初始值。对于高斯-牛顿迭代法中LiDAR的每个可能的位置+Δrt,LiDARn′，计算式(18)中扫描帧St的每个扫描点落在某个栅格中的概率。计算公式为 (19)式中，α和β为该扫描点在激光雷达系下的方位角和俯仰角测量值；xcentern′为距离扫描点最近的栅格中心点；d为两个点之间的距离；σ为LiDAR测距误差；P(xcentern′|Mt-1)为t-1时刻该栅格点的概率值。最终求得的rt,LiDARn′对应的每个扫描点也对Mt-1进行了更新，如P(xt,ln′|Mt-1)即为该时刻距离扫描点xt,ln′最近栅格的最新概率。直至所有时刻的扫描帧迭代更新地图，即可获得完整的栅格占有图。

1.4 基于栅格地图匹配的标定参数估计将安装于多个已知点的LiDAR标签获取的点云与生成的栅格占有图进行地图匹配，计算LiDAR标签在近似导航系n′系下坐标。帧与地图匹配采用高斯-牛顿迭代法，将LiDAR标签在n系下的位置Pn作为高斯-牛顿迭代法的位置初始值，初始姿态采用人工对准的方式获得。参照1.3节中的地图匹配方法，获得LiDAR标签在n′系下的姿态CLiDARmarkn′和位置rLiDARmarkn′。统计所有时刻的LiDAR标签点云的Ct,LiDARmarkn′和 rt,LiDARmarkn′，可建立方程如式(20)所示 (20)式中，i为第i个LiDAR标签。通过非线性优化算法对式(20)中最优化问题进行求解可得到近似n′系与n系的转换参数(Cn′n, Tn′n)。基于LiDAR-IMU的标定参数初始值Clb′和Tlb′可求得真实标定参数。具体公式为 (21)

2 试验验证试验选择在武汉某园区内进行，图 2(a)为测试环境，可以看出环境中主要特征为建筑物的立柱，且特征存在重复性。图 2(b)为本文采用的1台移动的LiDAR雷达标签，采用GNSS RTK静态测量获得15个已知点的厘米级三维绝对坐标。图 2(c)为待标定的车载LiDAR/IMU设备，其中车载GNSS设备为天宝BD982双频板卡，IMU为霍尼韦尔4930战术级模块，均内置于结构外壳中，车载LiDAR和LiDAR标签均为Velodyne-16线激光雷达。表 1和表 2显示了IMU和LiDAR的性能参数。图 2 试验环境与激光雷达标签Fig. 2 Experimental environment and LiDAR labels图选项

表 1 IMU性能参数Tab. 1 Performance parameters of IMU

表选项

表 2 LiDAR性能参数Tab. 2 Performance parameters of LiDAR

表选项

在标定过程中，LiDAR会在15个已知点之间移动，车辆大致沿直线路线行驶，行驶长度约为100 m。图 3显示了行驶过程中车辆的航向角、俯仰角和速度。从图 3中可看出，航向角并不是严格保持不变，而是在86°~90°范围内波动，本文方法不需要严格约束车辆直线行驶。俯仰角反映了道路坡度，从图 2(a)可看出，道路较为平坦，因此俯仰角波动也较小。为了体现本文方法对车辆运行速度不敏感，车辆在行驶期间维持变化的速度。

图 3 车辆行驶中航向角、俯仰角和速度的变化Fig. 3 Changes of yaw angle, pitch angle and speed of vehicle during the trip图选项

图 4显示了基于LiDAR/IMU标定参数初始值和IMU组合导航结果拼接的n系下的LiDAR点云图。从图 4中可看出，虽然标定参数有误差，建筑物轮廓和道路轮廓基本保持为直线，证明了2.2节描述的标定参数误差不会造成地图扭转的结论。但是图 4中的点云看起来非常杂乱，点云重影严重，使地图非常不清晰，同时也证明了1.2节描述的标定参数误差下利用组合导航位姿结果拼接造成的点云重影问题。

图 4 基于标定参数初始值和组合导航结果的LiDAR点云拼接结果Fig. 4 The mosaicked LiDAR point cloud using initial calibration parameters and combined navigation results图选项

图 5为基于1.3节方法构建的姿态约束的LiDAR栅格占有图。已知点在n系下的坐标预先通过静态GNSS-RTK获得。采用5个雷达标签参与1.4节中的计算估计标定参数，10个雷达标签验证估计参数的精度。从图 5中可看出，LiDAR点云经过姿态约束和地图匹配后，构建的地图清晰，点云重影问题得到了极大的缓解，且图中几何特征明显，比如U形的建筑物柱子轮廓，这些几何特征可以提高地图匹配和构图的精度。值得注意的是，虽然本次构建的地图精度高，但是本图是在n′系而不是n系，为了获取标定参数的精确估计值，需要将地图从n′系转到n系，求解n′系与n系的转换参数。

图 5 基于姿态约束LiDAR栅格占有图的点云拼接结果Fig. 5 The mosaicked LiDAR point cloud using LiDAR occupancy map method with attitude constraints图选项

基于雷达标签的点云和图 5中栅格占有图的地图匹配，可以获得雷达标签在n′系中的位置。图 6(a)为雷达标签点云与图 5中栅格占有图的地图匹配效果图。图 6(b)为基于地图匹配的结果拼接的雷达标签点云图。从图 6中可看出，基于高斯-牛顿法的地图匹配精度高，比如6(a)中U形的建筑物柱子轮廓的黄色点云与白色点云基本是重合的。一方面是因为本文选取的测试场地几何特征丰富，另一方面说明了高斯-牛顿法的稳健性和可靠性。从图 6(b)也可看出，基于高精度匹配结果拼接的雷达标签点云也非常清晰，并且涵盖了场地内大部分的几何特征。

图 6 基于栅格占有图地图匹配的雷达标签点云拼接结果Fig. 6 The mosaicked LiDAR point cloud of LiDAR labels using the occupancy map图选项

依据式(20)可通过5个安装在已知点的雷达标签在n系下的高精度位置和其在n′系下的地图匹配位置结果来估计n′系与n系的转换参数，最后通过式(21)求解LiDAR/IMU标定参数的估计值。为了验证式(21)求解的LiDAR/IMU标定参数的估计值精度，图 7显示了在n系下利用估计的标定参数与IMU组合导航结果拼接的点云图。对比图 4中利用标定参数初始值拼接的点云图，地图精度极大提高，点云重影问题也得到了极大的缓解，与图 5中姿态约束的LiDAR栅格占有图的精度相当。

图 7 基于标定参数估计值的LiDAR点云拼接结果Fig. 7 The mosaicked LiDAR point cloud using the estimated calibration parameters图选项

为了定量分析标定参数的估计精度，本文采用10个已知点上安装的雷达标签点云与图 7中的点云图做地图匹配，基于高斯-牛顿法获得雷达标签在n系中的位置，最后与对应的已知点的位置进行对比。图 8显示了利用GNSS-RTK采集的15个已知点在n系下的高精度位置(蓝色三角形)，作为已知点的位置真值；显示了参与1.4节中标定参数估计的5个已知点通过与图 5中的栅格占有图匹配获得的在n′系下的位置(黑色正方形)，注意图中已将n系和n′系的原点重合；显示了用于标定参数精度验证的10个已知点在n′系下的位置(绿色正方形)；显示了通过与图 7基于标定参数估计值拼接的LiDAR点云图匹配得到的10个已知点在n系下位置(红色圆)。从图 8中可看出，利用标定参数初值获得的n′系中的已知点位置与位置真值存在较大的偏差，利用估计的标定参数获得的n系中的已知点位置与位置真值基本重合。表 3显示了匹配得到的10个已知点在n系下的位置与真值之间的水平偏差，偏差为厘米级，证明了估计的标定参数的高精度。图 8 15个已知点在不同框架下的位置Fig. 8 Positions of the 15 known points in different frames图选项

表 3 基于估计的标定参数计算的10个已知点位置与真值的三维偏差Tab. 3 Position errors of the 10 known points using estimated calibration parameters m

表选项

3 结论本文提出了一种不依赖人工布设标志物的LiDAR/IMU空间标定方法，采用放置于高精度已知位置的LiDAR标签提供绝对空间基准，基于GNSS-RTK和IMU组合导航获得IMU的高精度轨迹。从理论上分析了利用IMU的位置和姿态与标定参数初始值拼接的LiDAR点云图的点云重影问题，以及证明了LiDAR点云图方向上的一致性特性。基于该特性，本文提出一种基于IMU姿态约束的LiDAR栅格占有图构建方法，进而利用LiDAR标签点云与地图匹配获得LiDAR标签在地图坐标系中的位置，通过LiDAR已知高精度位置和非线性优化方法，实现地图坐标系与绝对空间基准的空间转换，最终基于该转换关系计算LiDAR/IMU的标定参数。通过试验验证，本文方法只需预先采集LiDAR标签的位置、组合导航结果和LiDAR标签点云，可以极大地简化LiDAR/IMU空间标定流程，实现了空间标定的自动化。利用已知点验证了本文标定方法的精度，标定参数可以实现厘米级的绝对坐标系下制图结果。作者简介第一作者简介：钱闯(1989-), 男, 博士, 副研究员, 研究方向为智能驾驶、智能交通、多源传感器融合、车辆高精度定位。E-mail: qian_c@whut.edu.cn通信作者：张红娟, E-mail: hongjuanzhang@whu.edu.cn

初审：张艳玲复审：宋启凡
终审：金 君

资讯