传感器标定 为什么 自动驾驶系统的传感器标定方法

自动驾驶系统的传感器标定方法

来源：智车科技

这个工作可分成两部分：内参标定和外参标定 ，内参是决定传感器内部的映射关系，比如摄像头的焦距，偏心和像素横纵比（+畸变系数），而外参是决定传感器和外部某个坐标系的转换关系，比如姿态参数（旋转和平移6自由度）。

摄像头的标定曾经是计算机视觉中3-D重建的前提，张正友老师著名的的Zhang氏标定法，利用Absolute Conic不变性得到的平面标定算法简化了控制场。

这里重点是，讨论不同传感器之间的外参标定，特别是激光雷达和摄像头之间的标定。

另外在自动驾驶研发中，GPS/IMU和摄像头或者激光雷达的标定，雷达和摄像头之间的标定也是常见的。不同传感器之间标定最大的问题是如何衡量最佳，因为获取的数据类型不一样：

这样的话，实现标定误差最小化的目标函数会因为不同传感器配对而不同。

另外，标定方法分targetless 和target 两种，前者在自然环境中进行，约束条件少，不需要用专门的target；后者则需要专门的控制场，有ground truth的target，比如典型的棋盘格平面板。

这里仅限于targetless方法的讨论，依次给出标定的若干算法。

01 首先是手眼标定

这是一个被标定方法普遍研究的，一定约束条件下的问题：可以广义的理解，一个“手” （比如GPS/IMU）和一个“眼” （激光雷达/摄像头）都固定在一个机器上，那么当机器运动之后，“手”和“眼”发生的姿态变化一定满足一定的约束关系，这样求解一个方程就可以得到“手”-“眼”之间的坐标转换关系，一般是AX=XB形式的方程。

手眼系统分两种：eye in hand 和eye to hand ，我们这里显然是前者，即手-眼都在动的情况。

手眼标定分两步法 和单步法 ，后者最有名的论文是“hand eye calibration using dual quaternion"。一般认为，单步法精度高于两步法，前者估计旋转之后再估计平移。

这里通过东京大学的论文“LiDAR and Camera Calibration using Motion Estimated by Sensor Fusion Odometry”来看看激光雷达和摄像头的标定算法。

显然它是求解一个手-眼标定的扩展问题-，即2D-3D标定，如图所示：

求解激光雷达的姿态变化采用ICP，而摄像头的运动采用特征匹配。后者有一个单目SFM的scale问题，论文提出了一个基于传感器融合的解法：初始估计来自于无尺度的摄像头运动和有尺度的激光雷达运动；之后有scale的摄像头运动会在加上激光雷达点云数据被重新估计。最后二者的外参数就能通过手-眼标定得到。下图是算法流程图：

手眼标定的典型解法是两步法： 先求解旋转矩阵，然后再估计平移向量，公式在下面给出：

现在因为scale问题，上述解法不稳定，所以要利用激光雷达的数据做文章，见下图：

3-D点云的点在图像中被跟踪，其2D-3D对应关系可以描述为如下公式：

而求解的问题变成了：

上面优化问题的初始解是通过经典的P3P得到的。

得到摄像头的运动参数之后可以在两步手眼标定法中得到旋转和平移6参数，其中平移估计如下：

注：这里估计摄像头运动和估计手眼标定是交替进行的，以改进估计精度。除此之外，作者也发现一些摄像头运动影响标定精度的策略，看下图分析：

可以总结出：1） 摄像头实际运动a 越小，投影误差越小；2） ( )越小，投影误差越小。第一点说明标定时候摄像头运动要小，第二点说明，标定的周围环境深度要变化小，比如墙壁。

另外还发现，增加摄像头运动的旋转角，摄像头运动估计到手眼标定的误差传播会小。

这个方法无法在室外自然环境中使用，因为点云投影的图像点很难确定。

有三篇关于如何优化激光雷达-摄像头标定的论文，不是通过3-D点云和图像点的匹配误差来估计标定参数，而是直接计算点云在图像平面形成的深度图，其和摄像头获取的图像存在全局匹配的测度。

不过这些方法，需要大量迭代，最好的做法是根据手眼标定产生初始值为好。

另外，密西根大学是采用了激光雷达反射值，悉尼大学在此基础上改进，两个都不如斯坦福大学方法方便，直接用点云和图像匹配实现标定。

斯坦福论文“Automatic Online Calibration of Cameras and Lasers”。

斯坦福的方法是在线修正标定的“漂移” ，如下图所示：精确的标定应该使图中绿色点（深度不连续）和红色边缘（通过逆距离变换 IDT，即inverse distance transform）匹配。

标定的目标函数是这样定义的：

其中w 是视频窗大小，f 是帧#，(i, j) 是图像中的像素位置，而p是点云的3-D点。X表示激光雷达点云数据，D是图像做过IDT的结果。

下图是实时在线标定的结果例子：

第一行标定好的，第二行出现漂移，第三行重新标定。

密西根大学的论文“Automatic Targetless Extrinsic Calibration of a 3D Lidar and Camera by Maximizing Mutual Information”。

这里定义了标定的任务就是求解两个传感器之间的转换关系，如图：求解R，T。

定义的Mutual Information (MI) 目标函数是一个熵值：

求解的算法是梯度法：

下图是一个标定的例子：RGB像素和点云校准。

澳大利亚悉尼大学的论文“Automatic Calibration of Lidar and Camera Images using Normalized Mutual Information”。

本文是对上面方法的改进。传感器配置如图：

标定的流程在下图给出：

其中定义了一个新测度Gradient Orientation Measure (GOM)如下：

实际上是图像和激光雷达点云的梯度相关测度。

点云数据和图像数据匹配时候需要将点云投影到柱面图像上，如图所示：

投影公式如下：

而点云的梯度计算之前需要将点云投影到球面上，公式如下：

最后，点云的梯度计算方法如下：

标定的任务就是求解GOM最大，而文中采用了蒙特卡洛方法 ，类似particle filter。下图是一个结果做例子：

IMU-摄像头标定

德国Fraunhofer论文“INS-Camera Calibration without Ground Control Points“。

本文虽然是给无人机的标定，对车辆也适合。

这是IMU定义的East, North, Up (ENU) 坐标系：

而实际上IMU-摄像头标定和激光雷达-摄像头标定都是类似的，先解决一个手眼标定，然后优化结果 。只是IMU没有反馈信息可用，只有姿态数据，所以就做pose graph optimization。下图是流程图：其中摄像头还是用SFM估计姿态。

这是使用的图像标定板：

03 激光雷达系统标定

牛津大学论文“Automatic self-calibration of a full field-of-view 3D n-laser scanner".

本文定义点云的“crispness” 作为质量测度，通过一个熵函数Rényi Quadratic Entropy (RQE）最小化作为在线标定激光雷达的优化目标。（注：其中作者还讨论了激光雷达的时钟偏差问题解决方案）

“crisp“其实是描述点云分布作为一个GMM（Gaussian Mixture Model）形式下的致密度。根据信息熵的定义，RQE被选择为测度：

下图是一个标定后采集的点云结果：

标定算法如下：

04 雷达-摄像头标定

西安交大论文“Integrating Millimeter Wave Radar with a Monocular Vision Sensor for On-Road Obstacle Detection Applications”。

在讲传感器融合的时候提过这部分工作，这里重点介绍标定部分。首先坐标系关系如下：

传感器配置如下：

标定环境如下：

标定其实是计算图像平面和雷达反射面之间的homography矩阵参数，如下图：

传感器知识大全——浅谈电化学传感器标定

毒气检测的重要性在很早就已经被人们所认同，传统的检测方法是利用仪器分析设备，其价格昂贵，操作复杂，不能市场化，被人们所不能接受。20世纪中期电化学气体传感器 的诞生，将毒气检测推向一个转折点，为此行业做出了重大贡献。

随着市场的发展，廉价传感器层出不穷，针对近期客户所关心的并且经常问及的问题“传感器及整机标定方法”与大家分享一下：

标定过程可分为两种情况：标气标定、蒸气标定

一、标气标定

一般适用于较为常见的气体标定，比如CO、H2S、NH3、Cl2等

1、逐个标定

所需器件：气源、流量计、橡胶管、气路（PTFE管）、气罩、减压阀

操作步骤：

1）找寻或采购合适浓度的气源（一般采用钢瓶气源）；

2）将减压阀安装在气源上，提供减压控制功能；

3）连接好气路，PTFE管两侧采用短橡胶管连接；

4）气路另一侧连接好流量计；

5）将传感器对应尺寸的气罩安装在流量计上；

6）打开钢瓶气阀，调整流量，通气5min后开始标定。

以下为器件图示，可供使用参考：

图1 气源

图2 气路

图3 流量计

图4 气罩

图5 连接图

2、多个标定

所需器材：气源（标气）、注射剂、铝箔气袋、气箱

操作步骤：

1）用气袋从气源采集气体；

2）将所需要标定的整机放入气箱内，摆放整齐，不可叠加；

3）采用注射剂抽取相应比例的气体，注入气箱内。

注：1）气箱不应过大，以免气体扩散不均匀；

2）气箱内对角安装小风扇，以加快气体流动扩散。

以下为器件图示，可供使用参考：

图6 气源

图7 气箱

图8 铝箔气袋

图9 气体注射剂

二、蒸气标定

CO等毒气较为常见，一般情况下是以气体形式存在，但是由于大多数有机物是以液体形式存在，易液化，因此有机物标气不常见，标气误差也比较大，所以较为简单的标定方法即为蒸气标定。即采用液体蒸发，控制其蒸发气体浓度，以此对传感器或整机进行标定。

常见类似化学物质有苯、甲苯、三甲胺、乙酸乙酯、二硫化碳等。

所需器材：气源（液体）、气箱（带加热板）、微量注射剂

操作步骤：

1）将整机放入带加热板的气象内；

2）采用微量注射剂抽取相应体积的试剂；

3）将试剂注射在气象内的加热板上，加热蒸发，进行标定。

注：1）气象内需装配有加热板，便于液体快速蒸发形成气体；

2）气箱对角需安放风扇，对流空气。

以下为器件图示，可供使用参考：

图8 液体气源

图9 微量注射剂

图10 气箱（带加热板）

相关问答

传感器校正指的是标准物与传感器之间达到一个对等关系。是使不准确的产品,调到一个精确数值的一个过程。如气体传感器,就是用99.999%标准的气体来校准。这样...

传感器自动标错误维修按以下方法维修:1、对于750W以下的交流伺服,一般情况下可直接单相220Ⅴ接入激光切割机驱动器的L1,L3端子,2、对于其他型号激光切割机...

首先我们需要了解一下拉力传感器的优缺点有哪些。拉力传感器的优点是精度高,测量范围广,寿命长,结构简单,频响特性好,能在恶劣条件下工作,易于实现小型化、整...

所有的传感器出厂时都需要标定,只有标定好的传感器才能提供给客户。温度传感器当然也一样,温度传感器的标定和大多数其它传感器的标定一样,最普遍的方法就是...

你说的应该是,位移传感器,对感应范围的一个调节,达到最优的分辨率!如,一个传感器可以测量的范围是0--30cm精度可以达0.1cm,但现在我需要测的范围是0--15cm...

没有做钢丝绳偏移量的校正吧。钢丝绳多与少对于轴承座的压力不同。需要做校正。空钩建议离地一米时做空载标定。重物离地后做量程标定。如果能双传感器安装,可...

如果您的Phantom4出现视觉传感器/视觉系统异常,请检查前视避障是否出现污损的情况,如果有此类情况,请尝试擦拭干净,如果还是出现异常提示,可进行视觉校准尝...

1、将传感器全量程标准输入量分成若干个间断点,取各点的值作为标准输入值。2、由小到大一点一点地输入标准值,待输出稳定后记录与各输入值相对应的输出值。3...

利用标准器具对传感器进行标度的过程称为标定。具体到压电式压力传感器来说,用专用的标定设备,如活塞式压力计,产生一个大小已知的标准力。作用在传感器上,...

出现视觉传感器/视觉系统异常,请检查前视避障是否出现污损的情况,如果有此类情况,请尝试擦拭干净,如果还是出现异常提示,可进行视觉校准尝试解决。出现视觉传...