EKF3 水平位置源换成 VIO:室内无 GPS 的配置清单与四条验收判据
室内飞行的第一个硬约束不是控制,是定位。没有 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 的启动过渡期,永远不要拿来下结论。