[发明专利]激光雷达与IMU外参标定方法及装置

说明书

本申请涉及一种激光雷达与IMU外参标定方法及装置，属于计算机技术领域，该方法包括：获取激光雷达采集到的点云数据和IMU采集到的惯性测量数据；基于点云数据进行点云匹配计算当前的激光雷达位姿信息；基于惯性测量数据计算当前的IMU位姿信息；将激光雷达位姿信息和IMU位姿信息基于时间戳进行对齐，得到对齐后的位姿信息组；使用RANSAC算法基于对齐后的位姿信息组确定外参标定值；可以解决仅使用手眼标定方程进行外参标定时导致的稳定性和准确性较差的问题；由于RANSAC算法可以很好地去除手眼标定位姿中异常位姿对结果的影响，因此，可以解决可以提高标定结果的准确性和稳定性。

技术领域

本申请涉及一种激光雷达与IMU外参标定方法及装置，属于计算机技术领域。

背景技术

建图与定位是无人驾驶车辆实现自动驾驶的关键技术。在车辆实际运行中，使用单一传感器进行测量可能由于传感器本身的限制导致较大的测量误差。目前，使用激光雷达和惯性测量单元(Inertial Measurement Unit，IMU)融合的方案是目前工业界的主流研究方向。由于不同传感器在载具上分别装配在不同的位置，同时安装时的姿态角也可能不一致，因此，标定出两种传感器之间精准的位置和姿态角的偏差(即传感器的外参)是实现传感器参数融合的重要基础。

在对激光雷达和IMU的外参进行标定时，通过使用手眼标定方程进行标定，即分别求解激光雷达和IMU在特定时刻的运动信息，再利用两者位姿之间的约束建立目标方程，通过优化该目标方程得到结果。

然而，求得的传感器里程信息会含有很多的异常数据，用这个结果带入直接求解得到的标定结果不稳定，同时存在较大的误差。

发明内容

本申请提供了一种激光雷达与IMU外参标定方法及装置，可以解决仅使用手眼标定方程进行外参标定时导致的稳定性和准确性较差的问题。本申请提供如下技术方案：

第一方面，提供了一种激光雷达与IMU外参标定方法，所述方法包括：

获取所述激光雷达采集到的点云数据和所述IMU采集到的惯性测量数据；

基于所述点云数据计算当前的激光雷达位姿信息；

基于所述惯性测量数据计算当前的IMU位姿信息；

将所述激光雷达位姿信息和所述IMU位姿信息基于时间戳进行对齐，得到对齐后的位姿信息组；

使用所述RANSAC算法基于所述对齐后的位姿信息组确定外参标定值。

可选地，所述使用所述RANSAC算法基于所述对齐后的位姿信息组确定外参标定值，包括：

循环执行下述步骤，直至循环条件不满足预设条件时停止：将多组所述对齐后的位姿信息组输入手眼标定方程，得到粗略外参估计值；使用所述RANSAC算法和所述粗略外参估计值确定粗略模型得分、以及所述多组所述对齐后的位姿信息组中的粗略外点集和粗略内点集；在所述粗略模型得分高于得分阈值时，将所述粗略外参估计值对应的参数模型确定为候选参数模型；

循环执行下述步骤，直至从多个所述候选参数模型中筛选出唯一的参数模型时停止，得到该参数模型对应的外参标定值：对于每个候选参数模型对应的粗略内点集，将所述粗略内点集再次输入所述手眼标定方程，得到精细外参估计值；使用所述RANSAC算法和所述精细外参估计值再次确定精细模型得分、以及所述粗略内点集中的精细外点集和精细内点集；基于所述精细模型得分筛除不符合模型条件的候选参数模型。

可选地，所述预设条件为执行次数达到预设次数；或者，为候选参数模型的个数达到预设个数。

可选地，所述模型条件为对各个候选参数模型按照精细模型得分由高到低进行排序后，排序在前n位的候选参数模型，其中，n＝1/N，所述N为候选参数模型的个数。