TIO-Former：为纳米无人机打造的极轻量六向 ToF-惯性里程计

· Editorial Team estimated
纳米无人机 里程计 ToF 传感器 惯性融合 边缘计算 流式 Transformer

自主纳米无人机需要在严苛的尺寸、重量、功耗与算力约束下完成精确自运动估计，而相机与激光雷达超重、光流在低纹理场景退化、纯惯性解算又会漂移。多区飞行时间（ToF）阵列提供了轻量的度量补充，但仅凭每帧 384 个测距值做 6 自由度估计，要面对无效读数、各向异性的可观测性与随时间增长的计算量。本文提出 TIO-Former：一个无相机、无光流、无地图的测距-惯性里程计框架，仅依赖 IMU 与六个正交 8x8 ToF 阵列组成的 15 克载荷。前端用双边门控差分对齐相邻距离网格，并以 IMU 引导的交叉注意力按平台运动学动态路由方向特征；流式因果 Transformer 把未压缩的本地 KV 缓存与压缩的分块 FIFO 记忆结合，使推理开销与内存占用不随飞行时长增长。真实飞行中，它把开环位置误差相比纳米无人机光流降低 54.4%，相比学习型惯性基线降低 66.4%-89.1%，并在 RISC-V 边缘计算单元上实现 10.466 毫秒 P95 延迟与 6.324 MiB 峰值常驻内存。代码已开源。

原文 · arXiv:2609.17198

自主纳米无人机（nano-UAV）的自运动估计长期被 SWaP-C（尺寸、重量、功耗、算力）四重约束夹在中间：相机与激光雷达超出载荷预算，光流在低纹理场景退化，纯惯性解算则随时间累积漂移。多区飞行时间（ToF）阵列看起来是个合适的补充——重量轻、能给出直接的度量信息——但用每帧仅 384 个测距值恢复 6 自由度位姿，要同时处理无效读数、各向异性的可观测性和随时间增长的计算开销。

核心创新

TIO-Former 是一个无相机、无光流、无地图的测距-惯性里程计框架，输入只有 IMU 和六个正交 8x8 ToF 阵列（合计 15 克）。三处关键设计：

  1. 前端测距对齐：用双边门控差分处理相邻两帧距离网格，抑制无效读数与噪声；
  2. 运动学条件化特征路由：以 IMU 引导的交叉注意力，按平台当前运动学状态动态选择方向性特征，缓解六个阵列可观测性不均的问题；
  3. 有界记忆的流式推理：流式因果 Transformer 把未压缩的本地 KV 缓存与压缩的分块 FIFO 记忆结合，使单帧推理成本与内存占用不随飞行时长增长。

实验结果

  • 真实飞行：开环位置误差相比纳米无人机光流降低 54.4%，相比学习型惯性基线降低 66.4%-89.1%。
  • 环境与退化鲁棒性：在多个环境中评测，并测试了严重传感退化条件下的表现。
  • 边缘部署：在 RISC-V 伴随计算单元上达到 P95 延迟 10.466 毫秒，峰值常驻内存 6.324 MiB（不足系统内存的 5%）。
  • 代码已公开：https://github.com/Ly041021/TIO-Former

局限性

主要指标是开环位置误差的相对降幅，摘要没有给出绝对误差量级、飞行距离与速度剖面，因此无法判断其在具体任务中的可用边界。基线只包括光流与学习型惯性方法，未与相机-惯性里程计对比，而这正是该方案试图替代的对象。六个 ToF 阵列的量程与视场限制、以及它们在强烈日照或高反射表面下的表现没有讨论。10.47 毫秒是 P95 延迟，未说明是否已包含完整控制回路的其余环节。

行业影响

这项工作的直接意义在于用传感器选型换掉算法负担：如果低精度、低成本的 ToF 阵列配合合适的融合网络足以支撑 6 自由度估计，那么纳米级平台就不必再为视觉里程计付出重量与功耗代价。对室内巡检、受限空间搜救、管道与缝隙飞行这类载荷预算以克计的场景，这是一个可落地的替代路线。而「推理与内存不随航时增长」这一点对长航时任务的工程价值，可能比精度数字更大——它决定了能否在固定内存的 MCU 级芯片上长时间运行，而不是飞几分钟就溢出。开源代码也降低了复现门槛。