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+ 飞行轨迹,定义了系统辨识、控制器评测和状态估计三种标准化评估协议。
研究背景与动机¶
-
领域现状: 学习型方法推动了四旋翼自主化(强化学习赛车、自适应控制、MPC),但公开基准数据集多针对数百克到几公斤的平台。
-
纳米级差距: 50g 以下的纳米四旋翼(如 Crazyflie)面临低雷诺数空气动力学、有刷 DC 电机非线性、严苛计算限制——大平台的模型和控制器无法直接迁移,但没有标准化基准来研究这些问题。
-
核心贡献: 填补纳米级四旋翼的公开基准空白——同时记录全闭环栈(执行器→控制器→估计器→地面真值),支持三种标准化评估任务。
方法详解¶
硬件平台¶
- 飞行器: 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 |
三项标准化评估任务¶
- 系统辨识: 给定 \(\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
- 控制器评测: 在匹配初始电压条件(ΔV ≤ 0.05V)下比较跟踪性能。指标:位置 RMSE + 95th percentile + 控制能耗 \(E_u = \frac{1}{N}\sum\sum u_i(k)^2\)。5 次重复取均值
- 状态估计: 轻量 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+ 轨迹 + 三任务基线 + 详细同步验证
- 写作质量: ⭐⭐⭐⭐ 表格清晰,任务形式化规范
- 价值: ⭐⭐⭐⭐ 对纳米级机器人学研究社区有实质贡献