2. 导航传感器系统认知

水下机器人导航不是靠单一传感器完成的,而是由一组物理原理不同、误差特性互补的设备共同构成。理解每个传感器“测什么、怎么输出、在导航里扮演什么角色、有什么局限”,是后续标定与验收的前提。本节按“内部感知—外部感知—绝对定位”三层来梳理六类常用传感器,并给出接口与数据特性的工程要点。

一、三层感知结构:谁负责什么

第一层是内部感知,包括IMU和DVL。IMU测量载体自身的角速度和比力,经积分得到姿态、速度和位置,短时精度高、更新快,但误差随时间累积(纯惯导位置误差大致按时间三次方增长)。DVL向海底发射多普勒声波,测量载体相对海底的速度,直接抑制惯导的速度漂移,是水下组合导航的核心速度源。第二层是环境约束感知,包括深度计和磁力计:深度计提供绝对深度(压力换算),磁力计提供绝对方位(航向)参考,二者都能在长时间尺度上约束漂移,但分别受盐度/温度与磁干扰影响。第三层是外部绝对定位与感知,包括USBL、视觉和声呐:USBL通过声学往返给出机器人相对母船/基阵的绝对位置;视觉在近距、清水条件下提供相对位姿与目标识别;声呐(成像声呐、侧扫、多波束)在浑浊水和远距离下提供障碍、地形与目标信息。

第一层 · 内部感知(高频、短时准、随时间漂移) 第二层 · 环境约束(绝对量、低频、抑制漂移) 第三层 · 外部绝对定位与感知(场景依赖、信息丰富) IMU 惯性测量单元 角速度 + 比力 → 姿态/速度/位置 DVL 多普勒计程仪 对底/对水速度(三波束/四波束) 组合导航解算(惯导 + 速度/深度/方位) 输出姿态、速度、位置、航向 深度计(压力式) 绝对深度,受盐度/温度影响 磁力计(三轴) 绝对方位/航向,受磁干扰影响 误差观测与约束 深度约束垂向、航向约束水平姿态 USBL 超短基线 相对基阵的绝对位置(斜距+方位) 视觉(相机/双目) 近距相对位姿、目标识别 声呐(成像/侧扫/多波束) 障碍、地形、目标,浑浊水可用 实线:传感器数据流向解算;虚线:绝对量对惯导漂移的观测与约束

二、各传感器的导航角色与数据特性

IMU输出三轴角速度与三轴比力(加速度),典型采样率100~400 Hz,接口多为RS-422/RS-232串口或SPI,工业级MEMS零偏稳定性约1~10 °/h。它是姿态解算的骨架,但必须靠外部观测约束漂移。DVL输出三轴对底速度,采样率通常1~10 Hz,接口为RS-232/RS-485或以太网,关键参数是底跟踪高度范围(如0.3~100 m)和最小对底深度;超出高度会切到对水模式,此时速度含水流影响,不能直接当绝对速度用。深度计输出压力换算的深度,采样率1~10 Hz,接口常见模拟量+ADC或RS-485;其读数与当地重力加速度、海水密度相关,验收时需用已知深度点做线性度与零点检查。磁力计输出三轴磁场强度,采样率可达50~100 Hz,接口I²C/SPI;它给出绝对方位,但机器人本体电机、电池电流和铁磁结构会造成硬磁/软磁干扰,必须做椭球拟合标定。

USBL由换能器基阵与应答器组成,输出机器人相对基阵的斜距与方位角,进而换算为绝对坐标,更新率通常0.5~2 Hz,接口为RS-232/以太网并常带PPS同步;其精度受声速剖面、基阵安装角和多径影响,作用距离可达数百米至千米级。视觉输出图像与特征点,采样率15~30 fps,接口USB3/GigE;在清水近距(<5 m)可提供厘米级相对位姿,但浑浊水、弱光下迅速失效。声呐输出波束强度或点云,成像声呐更新率数Hz至十几Hz,接口以太网;它不受水体浑浊度影响,是避障与地形匹配的主力,但图像分辨率与距离成反比,且存在旁瓣假目标。

三、接口与时间同步的工程要点

多传感器融合的第一道坎不是算法,而是时间戳一致性。工程上应统一以PPS或PTP为基准,为每帧数据打上硬件时间戳;若某传感器只能给软件时间戳,需实测其传输延迟并在融合时补偿。第二道坎是坐标系统一:所有传感器安装位置需标定杆臂(lever arm),安装姿态需标定旋转矩阵,否则高速旋转时位置解算会出现米级误差。第三道坎是数据有效性判断:DVL的高度有效性、USBL的定位质量因子、磁力计的干扰标志都应进入融合逻辑,作为观测权重或剔除依据,而不是无条件信任。

教学示例(合理假设,非实测):某AUV配置IMU(200 Hz)、DVL(5 Hz)、深度计(5 Hz)、磁力计(50 Hz)、USBL(1 Hz)。融合时以IMU为预测主链,DVL提供速度观测,深度计约束垂向,磁力计约束航向,USBL在1 Hz时提供绝对位置修正。若USBL质量因子低于阈值,则临时降权而非直接使用。

四、选型与验收的关注点

选型时先看任务剖面:长航时大深度作业优先保证IMU零偏稳定性与DVL底跟踪能力;近距精细作业优先视觉与成像声呐;需要绝对位置闭环的优先USBL。验收时应逐项核对量程、分辨率、更新率、接口协议、供电与机械接口,并记录每台设备的序列号与固件版本。对深度计做零点与线性度检查,对磁力计做八面旋转标定,对DVL做静态零速与已知速度台架比对,对USBL做已知点位测距比对——这些数据将直接成为后续标定与验收章节的输入基线。