激光雷达、相机和惯性传感器相互约束的外参标定方法技术

本发明专利技术公开了一种激光雷达、相机和惯性传感器相互约束的外参标定方法，其包括以下步骤：制作棋盘格雷达反射板，并形成标定系统；静态标定激光雷达和相机，得到激光雷达到相机的转换外参；对惯性传感器分别从视觉角度和激光雷达角度进行动态标定；构建残差优化模型，通过将残差用最小二乘法进行非线性优化计算出相机与惯性传感器之间的转换外参；基于外参间的相互转换关系获取激光雷达与惯性传感器之间的转换外参，完成外参标定。本方法通过静态标定激光雷达和视觉相机、动态标定激光雷达和IMU、动态标定视觉相机和IMU互相结合的办法，使得各传感器形成相互约束的三角结构，实现高精度多传感器间的时空一致性和稳定性。精度多传感器间的时空一致性和稳定性。精度多传感器间的时空一致性和稳定性。

【技术实现步骤摘要】
激光雷达、相机和惯性传感器相互约束的外参标定方法


[0001]本专利技术涉及传感器融合领域，具体涉及一种激光雷达、相机和惯性传感器相互约束的外参标定方法。

技术介绍

[0002]SLAM(Simultaneous Localization and Mapping)技术，译为"同时定位与地图构建技术"。它是指安装了传感器的主体，在没有周围环境信息的条件下，通过传感器和自身运动估计自己的位姿，同时建立环境模型的技术。里程计(Odometry)技术是SLAM技术的前端，它通过不同的传感器数据来估计主体位置和姿态的变化。
[0003]目前已经有许多使用单一测量传感器的成功里程计框架，他们大多基于激光雷达或视觉相机。但是随着人们对智能机器人需求和要求的日益增长，SLAM技术也需要应对更复杂更具有挑战性的环境，因此近年来也引入IMU(惯性测量单元)、GPS(全球定位系统)等传感器进行辅助。多传感器结合的多模态融合里程计系统能综合各传感器的工作特性和区间，扬长避短，在部分传感器退化的情况中仍能鲁棒地工作，表现出了更强更广泛的应用。
[0004本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种激光雷达、相机和惯性传感器相互约束的外参标定方法，其特征在于，包括以下步骤：S1、制作棋盘格雷达反射板；将激光雷达、相机和惯性传感器之间的相对位置进行固定，并形成标定系统；其中棋盘格雷达反射板上设置有黑白相间的方形棋盘格图案，且黑白色部分图案的雷达反射率不同；S2、基于棋盘格雷达反射板，静态标定激光雷达和相机，得到激光雷达到相机的转换外参；S3、移动标定系统，对惯性传感器分别从视觉角度和激光雷达角度进行动态标定，分别得到相机与惯性传感器之间的外参初值、激光雷达与惯性传感器之间的外参初值、世界坐标系下一段时间内的多帧相机位姿和世界坐标系下的同一段时间下的多帧激光雷达位姿；S4、基于步骤S3得到的数据构建残差优化模型，通过将残差用最小二乘法进行非线性优化计算出相机与惯性传感器之间的转换外参；S5、基于相机与惯性传感器之间的转换外参和激光雷达到相机的转换外参，由相机
‑
惯性传感器
‑
激光雷达外参间的相互转换关系获取激光雷达与惯性传感器之间的转换外参，完成外参标定。2.根据权利要求1所述的激光雷达、相机和惯性传感器相互约束的外参标定方法，其特征在于，步骤S2的具体方法包括以下子步骤：S2
‑
1、获取相机的内参；S2
‑
2、固定棋盘格雷达反射板，分别使激光雷达和相机识别标定板上的点，对应得到3D雷达点云数据和2维图像数据；S2
‑
3、将3D雷达点云数据向2D投影，得到投影后的数据；S2
‑
4、将投影后的数据与2维图像数据中的对应点进行对齐，获取激光雷达到相机的转换外参3.根据权利要求1所述的激光雷达、相机和惯性传感器相互约束的外参标定方法，其特征在于，步骤S3中对惯性传感器从视觉角度进行动态标定的具体方法包括以下子步骤：A1、移动标定系统，获取惯性传感器数据和相机数据；A2、将惯性传感器数据向相机数据进行对齐；A3、将第k帧相机数据和第k+1帧相机数据之间的惯性传感器数据进行积分，得到两帧图像之间标定系统的相对位置、速度和旋转变化；A4、以惯性传感器到相机相对位置的变化值为初始值，将每一帧从图像中获取到的特征点重投影误差为优化对象，对优化对象进行非线性优化，得到采集时间内不同相机帧代表的时间点t＝[t
v1
,t
v2
,
…

【专利技术属性】
技术研发人员：杜欣泉，汪双，曾凤，陈财富，王贵锦，
申请(专利权)人：成都清融科技有限责任公司，
类型：发明
国别省市：