4. 系统架构与传感器融合

在无人机精准降落任务中,单一传感器几乎无法同时满足“远距离可发现、中距离可跟踪、近距离可精定位”的全过程需求。系统架构设计的核心,是把不同物理原理、不同量程、不同误差特性的传感器组织成一条可切换、可互补、可校验的观测链,再通过数据融合与状态估计,把原始观测转化为稳定可信的位姿与速度估计。对于容错与重试而言,架构是否具备冗余、融合是否具备故障隔离能力,直接决定降落失败后能否安全复飞或重试。

一、多传感器配置:分层观测与互补覆盖

典型的精准降落系统通常采用“全局定位 + 相对引导 + 末端精测”的三层配置。全局层由 GNSS/RTK、IMU、气压计和磁力计组成,负责提供绝对位置、姿态基准与高度趋势;相对引导层由视觉相机、下视光流、激光测距或UWB组成,负责在接近降落点时提供相对位置与速度;末端精测层由合作标志(如AprilTag、ArUco)、红外信标或高精度测距传感器组成,负责在最后数米内给出厘米级相对位姿。

这种分层配置的关键不是“传感器越多越好”,而是让每个传感器的有效量程、更新频率、抗干扰能力和失效模式形成互补。例如,GNSS在开阔环境稳定,但易受多径和遮挡影响;视觉在纹理丰富时精度高,但受光照和运动模糊影响;UWB在视距内稳定,但易受多径和非视距误差影响。配置时应明确每个传感器的“主用区间”和“备份区间”,避免所有传感器在同一物理量上同时失效。

二、数据融合方法:从加权平均到滤波估计

数据融合方法按复杂度可分为三个层次。第一层是加权平均与互补滤波,适合低频、低算力场景,例如用加速度计低频修正陀螺积分漂移;第二层是卡尔曼滤波及其变体(EKF、UKF),通过状态方程和观测方程把IMU高频预测与视觉/测距低频观测融合,输出连续位姿;第三层是因子图优化或滑动窗口优化,适合多传感器异步、多速率、带闭环约束的场景,但计算量较大。

在精准降落中,最常用的是误差状态卡尔曼滤波(ESKF)。其核心思想是把名义状态与误差状态分离,用IMU做高频递推,用视觉、测距、UWB等做低频观测更新。下面是一个简化的融合参数配置示例:

fusion:
  imu_rate: 200 Hz
  vision_rate: 30 Hz
  rangefinder_rate: 50 Hz
  uwb_rate: 20 Hz
  eskf:
    gyro_noise: 0.002 rad/s/√Hz
    accel_noise: 0.02 m/s²/√Hz
    vision_xy_noise: 0.03 m
    vision_z_noise: 0.05 m
    rangefinder_noise: 0.02 m
  outlier_gate: 3.0 sigma
  max_vision_dropout: 0.5 s

融合过程中必须设置观测门限与异常剔除机制。若某传感器观测残差超过3σ,应暂时降权或隔离,而不是直接参与更新。否则一次错误观测可能把状态估计拉偏,导致降落轨迹突变。

三、状态估计与冗余设计:可观测性与故障隔离

状态估计的目标是输出位置、速度、姿态、角速度、加速度以及传感器偏置。对于精准降落,最关键的估计量是相对降落点的水平位置、垂直高度和下降速度。冗余设计则要求:当主传感器失效时,系统仍能依靠备份传感器维持可观测性,并在有限时间内完成安全复飞或重试。

冗余可分为硬件冗余、解析冗余和时间冗余。硬件冗余是增加同类型传感器,如双IMU、双相机;解析冗余是利用不同物理原理的传感器互相校验,如视觉高度与激光测距互验;时间冗余是利用历史状态和运动模型短时预测,在传感器短暂丢失时维持估计。实际工程中,解析冗余往往比硬件冗余更经济,但需要设计合理的故障检测与隔离逻辑。

冗余设计检查清单:

  • 每个关键状态量是否至少有两个独立观测源?
  • 主传感器失效后,备份传感器是否能在0.5秒内接管?
  • 融合器是否具备残差监控与异常观测隔离?
  • 状态估计是否在传感器丢失时仍能短时递推?
  • 复飞或重试决策是否基于融合后的置信度而非单一传感器?
多传感器融合与状态估计架构 传感器层(多源观测) IMU 200 Hz 视觉相机 30 Hz 激光测距 50 Hz UWB 20 Hz GNSS/RTK 10 Hz 气压计 50 Hz 融合层(时间同步 · 异常剔除 · 观测更新) 时间同步 硬件触发/插值 残差门限 3σ 异常隔离 ESKF 更新 预测+校正 置信度评估 协方差/残差 状态估计层(输出与冗余判断) 位置/速度/姿态 相对降落点 传感器偏置 在线估计 健康状态 主/备切换 复飞/重试 决策输入 冗余反馈

四、案例与误区复盘

某次精准降落测试中,无人机在最后3米出现水平漂移,最终降落在标志点边缘。复盘发现:视觉相机因地面反光导致标志检测跳变,而融合器未启用残差门限,错误观测被直接用于更新,导致位置估计被拉偏。同时,激光测距虽然正常,但仅用于高度更新,未参与水平位置校验。改进方案是:启用3σ残差门限,增加视觉与UWB的水平位置互验,并在视觉连续丢失超过0.5秒时自动切换至UWB引导。

常见误区:把“传感器数量多”等同于“系统可靠”。如果多个传感器共享同一失效源(如共同安装板振动、共同供电、共同时间源),它们可能同时失效。冗余设计必须关注失效独立性,而不是简单堆叠。

设计维度推荐做法容错目标
传感器配置全局+相对+末端三层互补全量程覆盖,避免单点失效
融合方法ESKF为主,异常观测隔离抑制错误观测,保持估计稳定
状态估计输出位姿、速度、偏置与置信度为复飞/重试提供可信依据
冗余设计解析冗余优先,硬件冗余补充主传感器失效后0.5秒内接管
健康监控残差、协方差、丢失时间联合判断及时隔离故障,触发安全策略

综上,系统架构与传感器融合不是简单的“接传感器、跑滤波”,而是围绕精准降落全过程的可观测性、冗余性和故障隔离能力进行设计。只有让每个传感器在合适的区间发挥作用,让融合器具备异常剔除与置信度评估能力,让状态估计输出可供复飞与重试决策使用的健康信息,才能在真实环境中实现稳定、可重试的精准降落。