室内飞行的第一个硬约束不是控制,是定位。没有 GPS,ArduCopter 的 EKF3 必须从一个外部源拿水平位置和速度,
否则连 GUIDED 里的位置通道都用不了 —— 而我这套任务层恰恰只发位置指令。

这篇是”把光流换成 MICO VIO”这件事的完整记录:配置怎么做、怎么验、以及我在这上面错的四次。

一、先明确要接什么

量 从哪来 参数
水平位置 XY VIO(MAVLink VISION_POSITION_ESTIMATE) EK3_SRC1_POSXY = 6
水平速度 XY 同上 EK3_SRC1_VELXY = 6
垂直速度 同上 EK3_SRC1_VELZ = 6
高度 测距仪(ToF) EK3_SRC1_POSZ = 2
航向 VIO 的 yaw EK3_SRC1_YAW = 6
VIO 输入 MAVLink,串口 4 SERIAL4_PROTOCOL = 2、SERIAL4_BAUD = 921
测距仪 型号 10、朝向 25 RNGFND1_TYPE = 10、RNGFND1_ORIENT = 25、MIN = 0.01、MAX = 12
EKF 输入类型 视觉位置估计 VISO_TYPE = 1
飞控侧安装角 不做补偿 VISO_ORIENT = 0

最后两条是配套的:我这边 VIO 模块自己在助手软件里把安装角补偿成了「逆时针 315°」,
所以飞控侧必须留 VISO_ORIENT = 0;如果两边都补,航向就转两遍。

二、四条验收判据(这比”跑起来不报错”重要)

配完重启只是”参数进去了”,不代表能用。我用的四个判据:

① 静止 30 秒,位置不能漂。
实测跨度 x 0.003 m / y 0.004 m。超过 5 厘米就说明有系统性漂移,别急着飞。

② 手推 30 厘米,看位置跟不跟。
推完读 NED 的 x:0.278 m,量级对、方向对。

③ 方向必须”沿机头”,不能只是”有变化”。
漂移也能凑出数字,所以我用”推的方向 vs 位置变化方向”判断,而不是看有没有变化。

④ EKF 状态要真的把 VISUAL 用起来。
EKF flags = 0x037f(含 HPOS)、PosH 方差 = 0.000。方差不为 0 说明滤波器还在犹豫。

四条一起过,才算这套源真的生效。

三、四个坑(每个都花掉一整轮)

坑 1:VISO_TYPE = 3 会让 z 漂 −128 米。
不是我这里的写法问题,是这个取值下高度源打架。改回 1 立刻正常。

坑 2:EK3_SRC1_YAW = 0 同样不可用。
不用 VIO 的 yaw 就必须有别的航向源,室内没有磁罗盘可信数据,最后还是回到 6。

坑 3(最坑):EKF 刚启动的过渡漂移,不等于 VIO 坏了。
我在半空看到 z 漂 137 米、EKF 重启后 x 在 8 秒内涨到 6.866 米,都以为是 VIO 故障。
实际是:必须静止收敛 20~30 秒再看稳态,30 秒后复测是 0.003 米。
这条差点让我把一套正常的 VIO 换掉。

坑 4:父参数没打开时,子参数根本不存在。
VISO_TYPE = 0、RNGFND1_TYPE = 0 时,VISO_*_M_NSE、RNGFND1_ORIENT/MIN/MAX 这些参数在参数表里查不到。
写之前先把父参数打开,否则会得到一堆”写入成功但读回无此参数”。

四、也排除过的(省得再试一遍)

  • 换 VISO_TYPE 的其他取值 —— 已经试过,3 会漂
  • 改飞控 VISO_ORIENT 去凑航向 —— VIO 侧已补偿,这边改就是重复
  • 怀疑桌面纹理导致光流差 —— 深色桌面不是原因(换桌面后表现一致)

五、结论

这套配置在这台机器上稳定跑通了后续的完整任务(起飞 → 越线 4.5 m → 返航 → 降落,
北向 4.62 m、东向偏差 0.27 m)。

方法上的收获比参数本身大:判断”位置源能不能用”,要用静止漂移、方向、方差三件事,
而不是”有没有报错”;而 EKF 的启动过渡期,永远不要拿来下结论。