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秒内接管?
- 融合器是否具备残差监控与异常观测隔离?
- 状态估计是否在传感器丢失时仍能短时递推?
- 复飞或重试决策是否基于融合后的置信度而非单一传感器?
四、案例与误区复盘
某次精准降落测试中,无人机在最后3米出现水平漂移,最终降落在标志点边缘。复盘发现:视觉相机因地面反光导致标志检测跳变,而融合器未启用残差门限,错误观测被直接用于更新,导致位置估计被拉偏。同时,激光测距虽然正常,但仅用于高度更新,未参与水平位置校验。改进方案是:启用3σ残差门限,增加视觉与UWB的水平位置互验,并在视觉连续丢失超过0.5秒时自动切换至UWB引导。
常见误区:把“传感器数量多”等同于“系统可靠”。如果多个传感器共享同一失效源(如共同安装板振动、共同供电、共同时间源),它们可能同时失效。冗余设计必须关注失效独立性,而不是简单堆叠。
| 设计维度 | 推荐做法 | 容错目标 |
|---|---|---|
| 传感器配置 | 全局+相对+末端三层互补 | 全量程覆盖,避免单点失效 |
| 融合方法 | ESKF为主,异常观测隔离 | 抑制错误观测,保持估计稳定 |
| 状态估计 | 输出位姿、速度、偏置与置信度 | 为复飞/重试提供可信依据 |
| 冗余设计 | 解析冗余优先,硬件冗余补充 | 主传感器失效后0.5秒内接管 |
| 健康监控 | 残差、协方差、丢失时间联合判断 | 及时隔离故障,触发安全策略 |
综上,系统架构与传感器融合不是简单的“接传感器、跑滤波”,而是围绕精准降落全过程的可观测性、冗余性和故障隔离能力进行设计。只有让每个传感器在合适的区间发挥作用,让融合器具备异常剔除与置信度评估能力,让状态估计输出可供复飞与重试决策使用的健康信息,才能在真实环境中实现稳定、可重试的精准降落。