跳转至

NanoBench: A Multi-Task Benchmark Dataset for Nano-Quadrotor System Identification, Control, and State Estimation

日期: 2026-03-10
arXiv: 2603.09908
代码: 有
领域: 机器人 / 纳米四旋翼
关键词: nano-quadrotor, benchmark, Crazyflie, system identification, state estimation

一句话总结

发布 NanoBench——首个在商用纳米级四旋翼(Crazyflie 2.1, 27g)上同时提供执行器命令、控制器内部状态和估计器输出(配合毫米级 Vicon 地面真值)的开源多任务基准数据集,包含 170+ 飞行轨迹,定义了系统辨识、控制器评测和状态估计三种标准化评估协议。

研究背景与动机

  1. 领域现状: 学习型方法推动了四旋翼自主化(强化学习赛车、自适应控制、MPC),但公开基准数据集多针对数百克到几公斤的平台。

  2. 纳米级差距: 50g 以下的纳米四旋翼(如 Crazyflie)面临低雷诺数空气动力学、有刷 DC 电机非线性、严苛计算限制——大平台的模型和控制器无法直接迁移,但没有标准化基准来研究这些问题。

  3. 核心贡献: 填补纳米级四旋翼的公开基准空白——同时记录全闭环栈(执行器→控制器→估计器→地面真值),支持三种标准化评估任务。

方法详解

硬件平台

  • 飞行器: Crazyflie 2.1 — 92×92×29mm,27g 起飞重量,250mAh 单芯 LiPo
  • 执行器: 4 个 7×16mm 有刷 DC 马达驱动 46mm 四叶螺旋桨,满电推重比 ~2.2
  • 计算: STM32F405 (168 MHz Cortex-M4, 192kB SRAM)——仅能运行 EKF,无法跑视觉算法
  • 传感器: BMI088 六轴 IMU(加速度计+陀螺仪)
  • 地面真值: 12 相机 Vicon 系统,6×4×2m 覆盖范围,6.4mm 标记点,亚毫米精度@100Hz

数据采集管线

  • ROS 1 框架 + cflib Python 库通过 Crazyradio PA USB 通信
  • 三条并行数据通路
  • Vicon 路径:vrpn_client_ros → 位姿 + 一阶差分线速度 → CSV + 实时馈送 EKF
  • 固件遥测路径:cflib 拉取日志变量 → 主机时间戳 + 固件 tick 双标记 → 逐块 CSV
  • 命令路径:ExperimentRunner 编排飞行(起飞/降落用板载规划器,轨迹跟踪用 100Hz send_position_setpoint)

时间同步(核心技术)

  • 三个独立时钟:Vicon Tracker / Crazyflie 固件 tick / ROS host
  • 交叉相关对齐:将板载陀螺仪角速度 \(\boldsymbol{\omega}_{\text{gyro}}(t)\) 与 Vicon 四元数微分导出的角速度做互相关
  • \(\Delta t^* = \arg\max_{\Delta t} \sum_k \boldsymbol{\omega}_{\text{gyro}}(t_k) \cdot \boldsymbol{\omega}_{\text{vicon}}(t_k + \Delta t)\),搜索范围 [-2, 2]s,1ms 分辨率
  • 所有飞行残差对齐 < 0.5ms

12 种轨迹设计

类别 轨迹类型 目的 数量
A: 系统辨识激励 多正弦(0.1-5Hz, 15分量) 覆盖全频率动态模式 1
B: 几何跟踪 圆形/8字/椭圆/星形/Lissajous/Trefoil/螺旋/线性/随机/阶梯 各3种速度(0.5/0.75/1.0 m/s) ~30×3
C: 电池耗尽 长时悬停 捕获 4.2V→3.1V 全放电曲线 2

三项标准化评估任务

  1. 系统辨识: 给定 \(\mathbf{x}_0\) 和电机命令 \(\{u_i^{(k)}\}\),预测 h∈{0.1, 0.5, 1.0}s 后的 6-DoF 状态。需建模刚体动力学 \(m\ddot{\mathbf{p}} = \mathbf{R}(\mathbf{q})\sum T_i - mg\mathbf{e}_3 - \mathbf{D}_t \dot{\mathbf{p}}\)。指标:位置/速度/角速度/姿态的 MAE@各 horizon
  2. 控制器评测: 在匹配初始电压条件(ΔV ≤ 0.05V)下比较跟踪性能。指标:位置 RMSE + 95th percentile + 控制能耗 \(E_u = \frac{1}{N}\sum\sum u_i(k)^2\)。5 次重复取均值
  3. 状态估计: 轻量 EKF vs Vicon 地面真值。Horn SE(3) 对齐后计算 ATE + RTE + 逐轴速度残差 + 姿态 RMSE。5 次重复

实验关键数据

数据集统计

类别 轨迹数 总飞行时间 同步采样数
A (辨识) 1 ~1 min ~6K
B (跟踪) ~160 ~90 min ~540K
C (电池) 2 ~4 min ~24K
总计 170+ ~97.5 min 603,942

与现有数据集对比

特征 EuRoC Blackbird Busetto NanoBench
平台质量 ~2kg ~1kg <50g ~27g
轨迹数 11 176 4 170+
电机命令 RPM RPM PWM
EKF 输出
控制器内部
电池电压
多任务评估 仅 SysID SysID+Control+Est

关键发现

  • 纳米级特有挑战被量化:低雷诺数(~\(10^4\))导致推力特性与大平台完全不同——大平台模型直接迁移会严重退化
  • 电池电压对推力的影响非平稳:4.2V→3.1V 放电过程中推力持续衰减,现有仿真器用恒定参数无法建模→这是 sim-to-real gap 的关键来源
  • 168MHz MCU 的计算限制意味着只能跑轻量 EKF——需要在极有限资源下优化估计器

亮点与洞察

  • 首个纳米级完整闭环基准——从执行器到估计器全栈信号的数据集此前不存在
  • 电池电压记录 捕获了推力随放电变化的非平稳效应——这是 sim-to-real 迁移的关键未建模因素
  • 标准化评估协议 使不同研究组的算法终于可以公平比较

局限性 / 可改进方向

  • 无视觉传感器数据(无相机),限制了视觉惯性里程计的评估
  • 仅 Crazyflie 2.1 单一平台
  • 飞行速度受限于 1.0 m/s(纳米级平台的实际极限)

评分

  • 新颖性: ⭐⭐⭐⭐ 填补纳米级四旋翼基准空白
  • 实验充分度: ⭐⭐⭐⭐ 170+ 轨迹 + 三任务基线 + 详细同步验证
  • 写作质量: ⭐⭐⭐⭐ 表格清晰,任务形式化规范
  • 价值: ⭐⭐⭐⭐ 对纳米级机器人学研究社区有实质贡献