3. 导航传感器集成基础

AUV的自主航行能力，本质上取决于它对“我在哪、我朝哪、我多深、我离底多高、我动得多快”这五个问题的持续回答能力。惯性导航单元（INS/AHRS）、多普勒计程仪（DVL）、深度计、高度计与GPS，正是分别承担姿态与角速度、对地/对水速度、深度、离底高度和绝对位置基准的传感器组合。本节不讨论导航算法本身，而是聚焦集成链条上最容易被低估、却直接决定数据可用性的三个环节：安装、标定与数据接入。

一、安装：先解决“装在哪、朝哪、和谁对齐”

所有导航传感器集成的第一原则是统一参考系。工程上通常定义载体坐标系：X轴指向艇艏，Y轴指向右舷，Z轴向下，原点取在艇体几何中心或设计指定的浮心附近。每个传感器的安装位置（杆臂）和安装姿态（安装矩阵）都必须相对这个坐标系描述，否则后续的杆臂补偿和姿态融合无从谈起。

惯性导航单元应尽量安装在艇体重心附近、刚性好的位置，远离电机、推进器变频器和电源变换器等振动与电磁干扰源，其安装基准面需与载体坐标轴平行，安装误差建议控制在0.5°以内。DVL需要换能器阵面朝下且与艇体纵轴平行，波束平面尽量避开推进器尾流和艇体突出物，否则底跟踪会因气泡和湍流出现丢锁。深度计取压口应布置在艇体侧面平直段、远离螺旋桨和排水口的位置，避免动压干扰。高度计（通常为单波束测高声呐）与DVL一样朝下安装，但要注意其波束角与DVL波束的相互串扰，必要时错开工作频率或分时触发。GPS天线必须安装在出水后无遮挡的最高点，且与INS的杆臂要精确测量——因为GPS提供的是天线相位中心的位置，而INS输出的是其自身中心的位置。

二、标定：把安装误差和传感器误差“量出来”

标定分为两类。第一类是安装偏差标定：DVL的安装偏角（通常称为偏流角误差或misalignment）会让测得的对地速度在载体坐标系中产生一个固定旋转，典型量级为0.5°～2°，在2 m/s航速下对应约1.7～7 cm/s的横向速度误差，长时间积分后航迹会明显偏转。工程上常用“直线航行对比法”：在已知流向流速较弱的开阔水域，让AUV沿直线匀速航行，比较DVL速度矢量方向与GPS航迹方向，用最小二乘拟合出安装偏角并写入补偿参数。第二类是传感器自身标定：深度计需做零点与量程标定（压力源逐点加载，记录输出并拟合线性度）；DVL需在已知深度的试验水池或码头做底跟踪距离与速度精度检查；INS的陀螺零偏和加速度计零偏通常在静止状态下采集若干分钟数据求均值，作为初始零偏写入。

需要强调的是，标定结果不是一劳永逸的。DVL换能器表面附着生物膜、深度计取压口结垢、INS经历剧烈冲击后，都会使原有标定失效。建议在每次长航次前做一次快速核查：静止状态下检查INS零偏是否在阈值内，码头边用DVL对固定底面测距并与卷尺比对，深度计与气压/水柱参考比对。

三、数据接入：接口、协议与时间同步

数据接入的核心不是“接上线”，而是让每一帧数据都带着正确的时间戳和正确的坐标系语义进入导航计算机。常见接口包括RS-232/RS-485串口、CAN总线和以太网。INS多走串口或以太网输出二进制/ASCII组合导航数据；DVL常见RS-232或以太网输出速度与底跟踪距离；深度计多为RS-485或模拟量（4～20 mA）；高度计多为串口；GPS为串口NMEA或以太网。接入时需逐项确认波特率、数据位、校验位、更新率与输出格式，并在驱动层做帧头校验和超时检测。

时间同步是集成中最容易出问题的环节。GPS的PPS秒脉冲应作为全系统时间基准，INS和导航计算机通过PPS加NTP/PTP完成授时，其他传感器若无硬件授时能力，则在驱动层记录接收时间戳并标注“软时间戳”，在融合时按传输延迟做补偿。若各传感器时间戳不同源，DVL速度与INS姿态在高速转向时会出现明显错配，表现为组合导航输出抖动。

# 传感器接入配置示例（YAML，参数为教学示例值）
ins:
  port: /dev/ttyS1
  baud: 115200
  rate_hz: 100
  frame: BINARY_INS_V2
  lever_arm_m: [0.12, -0.05, 0.30]   # 相对载体原点
dvl:
  port: /dev/ttyS2
  baud: 115200
  rate_hz: 5
  misalign_deg: 1.35                  # 标定得到的安装偏角
  max_altitude_m: 80
depth:
  port: /dev/ttyS3
  baud: 9600
  rate_hz: 10
  zero_offset_m: 0.08                 # 取压口相对水线安装高度
altimeter:
  port: /dev/ttyS4
  baud: 9600
  rate_hz: 5
gps:
  port: /dev/ttyS5
  baud: 38400
  rate_hz: 5
  pps: /dev/pps0
  lever_arm_m: [0.40, 0.00, -0.55]

接入完成后必须做“数据体检”：在静止、匀速直航、定深悬停三种状态下分别记录各传感器原始输出，检查更新率是否稳定、有无丢帧、深度与高度读数是否与已知环境一致、DVL底跟踪是否在预期高度范围内保持锁定。只有原始数据干净可信，后续的组合导航才有意义。

把上述三件事做扎实，AUV才具备“传感器可信”的前提：安装保证了几何关系明确，标定保证了系统误差可控，数据接入保证了时间与语义一致。后续的组合导航、航迹控制与任务规划，都建立在这条集成链路的可靠性之上。