2. 导航传感器系统认知
水下机器人导航不是靠单一传感器完成的,而是由一组物理原理不同、误差特性互补的设备共同构成。理解每个传感器“测什么、怎么输出、在导航里扮演什么角色、有什么局限”,是后续标定与验收的前提。本节按“内部感知—外部感知—绝对定位”三层来梳理六类常用传感器,并给出接口与数据特性的工程要点。
一、三层感知结构:谁负责什么
第一层是内部感知,包括IMU和DVL。IMU测量载体自身的角速度和比力,经积分得到姿态、速度和位置,短时精度高、更新快,但误差随时间累积(纯惯导位置误差大致按时间三次方增长)。DVL向海底发射多普勒声波,测量载体相对海底的速度,直接抑制惯导的速度漂移,是水下组合导航的核心速度源。第二层是环境约束感知,包括深度计和磁力计:深度计提供绝对深度(压力换算),磁力计提供绝对方位(航向)参考,二者都能在长时间尺度上约束漂移,但分别受盐度/温度与磁干扰影响。第三层是外部绝对定位与感知,包括USBL、视觉和声呐: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的定位质量因子、磁力计的干扰标志都应进入融合逻辑,作为观测权重或剔除依据,而不是无条件信任。
四、选型与验收的关注点
选型时先看任务剖面:长航时大深度作业优先保证IMU零偏稳定性与DVL底跟踪能力;近距精细作业优先视觉与成像声呐;需要绝对位置闭环的优先USBL。验收时应逐项核对量程、分辨率、更新率、接口协议、供电与机械接口,并记录每台设备的序列号与固件版本。对深度计做零点与线性度检查,对磁力计做八面旋转标定,对DVL做静态零速与已知速度台架比对,对USBL做已知点位测距比对——这些数据将直接成为后续标定与验收章节的输入基线。