2、传感器基础:常见传感器的工作原理、坐标系定义与数据特性

在智能驾驶、机器人与空间感知系统中,传感器是获取环境信息与自身状态的核心硬件层。不同传感器在物理原理、输出频率、数据维度、噪声特性与坐标系定义上存在显著差异,直接决定了后续标定、外参估计与时间同步的策略选择。本章围绕相机、激光雷达、IMU、GPS/RTK与毫米波雷达五类主流传感器,系统梳理其工作原理、坐标系约定与数据特性,为后续多传感器融合建立统一的认知基础。

多传感器坐标系与数据特性总览 多传感器融合 标定 · 外参 · 时间同步 相机 (Camera) 光→电 · 透视投影 RGB图像 · 30/60Hz 激光雷达 (LiDAR) TOF/相位 · 3D点云 10/20Hz · 厘米级 IMU 加速度+角速度 100-1000Hz · 积分漂移 GPS/RTK 卫星定位 · 位置 10/20Hz · 厘米级(RTK) 毫米波雷达 FMCW · 距离/速度/角度 20-50Hz · 全天候 坐标系体系 传感器系 / 车体系 / 世界系 外参 = 刚体变换矩阵 数据特性:频率 · 延迟 · 噪声 · 维度 · 坐标系 外参标定:求解传感器坐标系→车体坐标系的旋转R与平移t 时间同步:统一各传感器时间戳,补偿延迟与触发偏差

2.1 相机:视觉感知的核心传感器

核心原理

相机通过光学镜头将三维场景投影到二维图像传感器(CMOS/CCD)上,利用光电效应将光信号转换为电信号,再经ADC量化为数字像素值。其成像模型遵循小孔成像原理,可用针孔模型数学描述:空间点 \(P(X,Y,Z)\) 经相机内参矩阵 \(K\) 与畸变系数映射到像素坐标 \(p(u,v)\)。内参包括焦距 \(f_x, f_y\)、主点 \(c_x, c_y\) 以及径向/切向畸变参数。相机输出的是稠密的RGB或灰度图像,具有丰富的纹理与颜色信息,但缺乏直接深度,且对光照变化敏感。

坐标系定义

  • 像素坐标系:原点在图像左上角,\(u\) 轴向右,\(v\) 轴向下,单位为像素。
  • 图像坐标系:原点在光轴与图像平面交点,\(x\) 轴向右,\(y\) 轴向下,单位为毫米。
  • 相机坐标系:原点在光心,\(Z\) 轴指向镜头前方,\(X\) 轴向右,\(Y\) 轴向下(符合右手定则但注意Y轴方向)。
  • 畸变模型:径向畸变(桶形/枕形)与切向畸变(镜头与传感器不平行)需在标定中求解。

数据特性与实战要点

属性典型值说明
分辨率1920×1080 / 3840×2160越高细节越丰富,但带宽与算力消耗增大
帧率30/60 FPS高帧率利于运动场景,但曝光时间缩短
输出格式YUV / RAW / JPEGRAW适合标定,YUV适合传输,JPEG适合存储
触发方式硬触发 / 软触发硬触发用于多传感器同步,延迟低至微秒级
噪声暗电流 / 读出噪声低照度下信噪比下降,影响特征提取
经验提醒:相机标定建议使用棋盘格或AprilTag,采集15-20张不同位姿图像,覆盖画面边缘与倾斜角度。标定后重投影误差应小于0.1像素,否则需检查图像清晰度或标定板平整度。
风险提示:卷帘快门(Rolling Shutter)在车辆高速运动或振动环境下会产生果冻效应,导致图像畸变。若用于外参标定或视觉SLAM,建议优先选择全局快门(Global Shutter)相机。

2.2 激光雷达:三维空间直接测量

核心原理

激光雷达(LiDAR)通过发射激光束并测量反射光的时间差(TOF)或相位差,计算目标距离。机械式LiDAR通过旋转电机带动激光收发模块,实现360°水平扫描;固态LiDAR则采用MEMS振镜或光学相控阵(OPA)实现扫描。输出为三维点云,每个点包含 \((x,y,z)\) 坐标和反射强度(Intensity)。点云密度与扫描线数相关,常见16线、32线、64线、128线。

坐标系定义

  • LiDAR坐标系:原点在激光雷达几何中心,\(X\) 轴指向车头前方,\(Y\) 轴指向左侧,\(Z\) 轴指向上方(右手系)。
  • 点云数据格式:通常以浮点型存储 \(x,y,z\)(单位米),强度值范围0-255。
  • 外参关系:LiDAR到车体坐标系的外参标定是融合的关键,常用ICP或NID算法求解。

数据特性与实战要点

属性典型值说明
测量范围0.1-200m远距离目标反射率影响测距精度
测距精度±2-3cm受温度、目标反射率、大气条件影响
扫描频率10/20Hz10Hz常用,20Hz适合高速场景
点云数量10-200万点/帧高线数点云稠密,但计算量增大
回波模式单回波 / 双回波双回波可穿透雨雾,但数据量翻倍
案例拆解:某园区无人车采用64线LiDAR,在雨天测试时发现点云出现大量噪点。分析发现,雨滴反射导致多路径效应,测距值偏大。解决方案:启用双回波模式,取最后一次回波(地面反射)作为有效值,同时将强度阈值从30提高到50,噪点减少约70%。代价是点云密度下降约15%,但目标检测精度保持稳定。
风险提示:LiDAR外参标定若使用ICP算法,初始值偏差过大会陷入局部最优。建议先用标定板或人工测量获取粗略初值,再使用ICP精配准,并检查配准后的点云重叠度是否大于95%。

2.3 IMU:高频运动状态感知

核心原理

惯性测量单元(IMU)集成了三轴加速度计和三轴陀螺仪,分别测量物体在载体坐标系下的比力(Specific Force)与角速度。加速度计基于MEMS电容或压阻效应,陀螺仪基于科里奥利效应(振动环或音叉式)。IMU输出频率高(100-1000Hz),但存在零偏(Bias)、尺度因子误差、随机游走(Random Walk)等误差源,积分后位置漂移严重,需与其他传感器融合校正。

坐标系定义

  • IMU坐标系:原点在IMU芯片中心,\(X\) 轴指向车头,\(Y\) 轴指向左侧,\(Z\) 轴指向上方(右手系)。
  • 加速度计:输出比力 \(f = a - g\),静止时读数为 \(g\) 的反向(即 \(Z\) 轴读数为 +9.8 m/s²)。
  • 陀螺仪:输出角速度 \(\omega\),单位 rad/s 或 °/s。

数据特性与实战要点

属性典型值说明
加速度量程±4g / ±8g / ±16g量程越大分辨率越低
陀螺仪量程±250 / ±500 / ±2000 °/s车辆场景常用±500°/s
零偏稳定性0.5-10 °/h高精度IMU零偏更小,价格更高
噪声密度0.01-0.1 m/s²/√Hz影响积分精度
输出频率200-1000Hz高频输出利于时间同步插值
经验提醒:IMU安装位置应尽量靠近车辆质心,减少杆臂效应(Lever Arm)带来的加速度误差。若无法避免,需在标定中补偿杆臂长度。
风险提示:IMU数据中的温漂不可忽视。车辆启动后IMU温度上升,零偏可能变化数倍。建议在标定前让IMU预热5-10分钟,并在算法中引入温度补偿模型。

2.4 GPS/RTK:位置与时间基准

核心原理

全球定位系统(GPS)通过接收至少4颗卫星的信号,利用伪距测量解算接收机位置。标准GPS精度约3-5米,而RTK(实时动态差分)技术通过地面基准站发送载波相位差分修正,可将精度提升至厘米级。RTK需要基准站与流动站之间的通信链路(4G/电台),且要求卫星可见性好、无多路径干扰。GPS还提供高精度的时间同步信号(PPS),是传感器时间同步的重要基准。

坐标系定义

  • WGS-84坐标系:GPS输出的经纬度基于WGS-84椭球体,需转换为UTM或局部直角坐标系(ENU)供融合算法使用。
  • ENU坐标系:原点在车辆起始位置,\(E\) 轴指向东,\(N\) 轴指向北,\(U\) 轴指向上方。
  • 车体坐标系:GPS天线安装位置与车体坐标系存在固定偏移,需作为外参标定的一部分。

数据特性与实战要点

属性标准GPSRTK
水平精度2-5m1-3cm
垂直精度4-8m3-5cm
更新频率1-10Hz10-20Hz
初始化时间即时10-60s(需固定解)
可靠性受遮挡影响受基站距离与通信质量影响
实战场景:某自动驾驶测试车在隧道中GPS信号丢失,RTK无法固定解。系统切换至IMU+轮速计航位推算模式,同时记录GPS信号丢失时刻的PPS时间戳。出隧道后GPS重新捕获,通过时间同步模块将IMU推算轨迹与GPS轨迹对齐,实现平滑切换。关键参数:IMU零偏补偿值、轮速计刻度因子、GPS天线杆臂长度。
风险提示:RTK的固定解状态(Fix)与浮点解(Float)精度差异巨大。融合算法必须检查RTK状态标志,浮点解时降低GPS权重,避免错误位置信息污染融合结果。

2.5 毫米波雷达:全天候目标探测

核心原理

毫米波雷达(MMWave Radar)工作在76-81GHz频段,采用调频连续波(FMCW)体制。发射信号频率随时间线性变化,接收回波与发射信号混频后得到中频信号,通过FFT提取目标的距离、速度与角度信息。距离分辨率取决于扫频带宽,速度分辨率取决于帧周期,角度分辨率取决于天线阵列孔径。毫米波雷达对金属目标反射强,可穿透雨雾尘,但点云稀疏,缺乏高度信息。

坐标系定义

  • 雷达坐标系:原点在雷达天线阵列中心,\(X\) 轴指向雷达前方,\(Y\) 轴指向左侧,\(Z\) 轴指向上方。
  • 目标输出:每个目标包含距离 \(r\)、径向速度 \(v\)、方位角 \(\theta\)、反射强度(RCS)。
  • 点云模式:部分雷达可输出原始点云(4D成像雷达),包含俯仰角信息。

数据特性与实战要点

属性典型值说明
探测距离0.2-250m远距离目标RCS需较大
距离精度±0.1-0.5m高带宽雷达精度更高
速度精度±0.1-0.5 m/s多普勒测量直接输出
角度分辨率1°-5°MIMO阵列可提高分辨率
更新频率20-50Hz高帧率利于动态目标跟踪
经验提醒:毫米波雷达的静态杂波滤除(如路侧护栏、金属井盖)需设置合理的CFAR检测阈值。若阈值过低,虚警率升高;过高则漏检小目标。建议根据场景动态调整。
风险提示:毫米波雷达对行人等低RCS目标反射较弱,且无法识别目标类别(如区分行人、自行车、车辆)。融合相机视觉信息可弥补此缺陷,但需保证雷达与相机外参标定精度在0.1°以内。

2.6 多传感器坐标系统一与数据特性对比

多传感器融合的首要任务是将各传感器数据统一到同一坐标系(通常为车体坐标系或世界坐标系)。外参标定即求解传感器坐标系到车体坐标系的刚体变换矩阵 \(T_{sensor}^{body} = [R|t]\)。不同传感器的数据特性差异直接影响标定方法与时间同步策略:相机提供稠密纹理但无深度,LiDAR提供稀疏深度但无颜色,IMU提供高频运动但漂移,GPS提供位置但低频,毫米波雷达提供目标级信息但稀疏。

传感器数据维度频率(Hz)延迟(ms)噪声特性坐标系基准
相机2D像素+RGB30-6010-30光照敏感像素/相机系
LiDAR3D点云+强度10-205-15距离噪声LiDAR系
IMU3轴加速度+3轴角速度200-10001-3零偏+随机游走IMU系
GPS/RTK经纬度+高度+速度10-2050-200多路径+遮挡WGS-84/ENU
毫米波雷达目标距离/速度/角度20-505-20虚警+漏检雷达系
综合案例:某L4级自动驾驶车辆在园区内进行多传感器标定。初始阶段,相机与LiDAR外参使用目标板法标定,重投影误差0.08像素;IMU与车体使用六面静止法标定,零偏稳定性0.8°/h;GPS天线杆臂用卷尺测量,精度±2cm。时间同步采用PPS+GPRMC方案,各传感器延迟补偿后,融合轨迹与RTK真值对比,横向误差<10cm。复盘发现,毫米波雷达与相机外参标定因目标板RCS不足导致角度偏差0.3°,后改用角反射器标定,误差降至0.05°。
总结复盘:传感器标定不是一次性工作。温度变化、机械振动、碰撞都可能导致外参漂移。建议每次车辆启动后运行在线标定检查(如LiDAR点云与相机图像边缘对齐度),偏差超阈值时触发重新标定。时间同步需定期检查各传感器时间戳偏移,特别是GPS信号丢失后恢复时,PPS同步可能跳变。