IEEE Transactions on Robotics

Robust and Agile Quadrotor Flight via Adaptive Unwinding-Free Quaternion Sliding-Mode Control

作者：Amin Yazdanshenas, Reza Faieghi · 机构：Autonomous Vehicles Laboratory, Department of Aerospace Engineering, Toronto Metropolitan University, Toronto, ON, Canada

会议/期刊：IEEE Transactions on Robotics · 发布日期：2025 · 页码：5246-5266

控制飞行机器人系统设计

精读笔记

Problem Setting

这篇论文处理的不是一般 quadrotor tracking，而是“在真实纳米四旋翼上做强扰动、高姿态角、高加速度飞行时，如何让 classical SMC 真正可用”。核心矛盾是：SMC 的鲁棒性需要足够强的切换项，但小平台的 actuator margin、噪声和算力又不允许粗暴高增益；姿态控制需要全局、无奇异、无 unwinding，但很多可分析形式又依赖 Euler 小角度近似或 SO(3) almost-global 结构。

以前方法卡在几个不同层面。Euler-SMC 的形式最适合写成二阶误差系统，但它牺牲了大姿态下的真实旋转动力学；SO(3) geometric controller 建模干净，但拓扑限制导致 almost-global，并且姿态误差收敛通常偏保守；quaternion controller 可以避开 Euler，但双覆盖会带来 unwinding；adaptive SMC 免去扰动上界，却常因增益单调增长变成 actuator saturation 和控制振荡问题。本文的任务就是把这些分散痛点在一个能上机的控制框架里同时处理掉。

Motivation

作者的动机很明确：SMC 在 quadrotor 文献里很多，但真正能在 aggressive hardware flight 中成立的并不多。大量 Euler-SMC 论文通过简化 rotational dynamics 获得漂亮结构，却没有正面面对大 roll/pitch；很多 adaptive SMC 的稳定证明看似完整，但增益只增不减，使其工程可用性很差；quaternion-SMC 方向又没有充分解决 unwinding 和全 6-DOF 集成验证。

关键缺口是“鲁棒性与几何正确性没有同时落地”。如果只要鲁棒，可以用 Euler-SMC；如果只要几何正确，可以用 GTC；如果只要全姿态表示，可以用 quaternion PD。但在纳米平台上同时要高机动、强抗扰、低控制努力、低算力和可证明稳定，已有路线都缺一块。本文就是把 quaternion 的全姿态表达、SMC 的鲁棒误差压制、以及非单调 adaptive gain 放到同一个简洁结构里。

Core Idea

真正核心思想是：不要在 SO(3) rotation matrix error 或 Euler angle error 上做 SMC，而是在 quaternion error 的“短弧分支”上定义滑模面。sgn_+(q_we) 不是装饰项，它等价于在控制层面显式选择 quaternion 双覆盖中的物理短路径，从而避免 unwinding。这个选择使滑模面在 q_we=0 处非光滑，但该集合是 measure-zero 且非不稳定吸引集；用 Clarke nonsmooth Lyapunov 分析后，整个设计可以保持严谨性。

第二个思想是：切换增益应该表示“当前鲁棒性需求”，而不是对历史误差的单调积分。传统 adaptive SMC 的 \dot{k}=\gamma|s| 本质上把所有过去的误差都永久转化成增益，迟早过保守。本文的 adaptive law 让 K 在误差大时上升、误差小时下降，并用 K_th 保底。这实际上是给 SMC 加了一个低维在线 gain scheduler，改变的是鲁棒项和扰动强度之间的信息流：由离线 worst-case tuning 变成在线 demand-driven tuning。

Method

1）Unwinding-free quaternion sliding surface：解决姿态误差表示问题。滑模面采用 omega_e 加 sign-corrected quaternion vector error，使控制律始终沿较短姿态误差方向工作。核心变化是把 quaternion 双覆盖从潜在病态变成显式分支选择；代价是非光滑性。

2）Nonsmooth Lyapunov proof：解决理论合法性问题。由于 sgn_+(q_we) 在 q_we=0 不可微，经典 Lyapunov 证明不够严谨。作者用 Clarke generalized gradient 分别处理 q_we=0 与非零情况，说明该非光滑点不会破坏 UUB。这里的贡献主要是把已有 unwinding-free heuristic 补成可发表的稳定性论证。

3）6-DOF SMC integration：解决外环/内环一致性问题。位置环输出虚拟力 kappa，thrust 由当前姿态投影得到，期望姿态由 kappa 和 desired yaw 构造，再把期望角速度/角加速度映射到当前姿态切空间。这个设计避免 Euler 反解成为 aggressive flight 的瓶颈，也让位置和姿态都受 SMC 鲁棒项保护。

4）Bidirectional adaptive switching gains：解决固定增益保守和传统自适应增益过大的矛盾。误差超过 epsilon phi 时增益增加，误差进入小邻域后增益下降；K_th 防止对突发扰动失去响应。它不是估计真实扰动上界，而是让切换增益跟踪控制误差需求。

Key Insight / Why It Works

最关键的有效性来源不是 tanh，也不是复杂参考生成，而是两个 inductive bias：第一，姿态误差必须在正确的几何空间里表达；第二，鲁棒增益应该跟随当前扰动需求而非历史误差累计。

QSMC 有效，是因为它保留了 quaternion 对大姿态的正确动力学表达，同时用 sign-corrected vector part 直接消除了 unwinding。相较 Euler-SMC，它不是更会调参，而是避免了错误模型在大角度下被控制器放大的问题。实验中 ESMC 在大姿态 gimbal 和 lemniscate 下失稳，正好说明这个差异是结构性的，不是 tuning 小问题。

AQSMC 的核心贡献更工程但很重要：它把 SMC 的 switching gain 从“最坏情况常数”变成“在线可恢复的资源”。这在纳米四旋翼上尤其关键，因为固定大增益会浪费控制努力并激发振荡，固定小增益又扛不住风扰。传统 adaptive law 只会把 K 往上推，本质上把短时扰动永久记忆为高增益；本文允许遗忘，这比单调 adaptive 更符合实际 disturbance profile。

哪些是辅助？tanh 边界层主要是工程上抑制 chattering，理论上也带来 UUB 而非精确滑模；参考生成中的高阶导数推导是必要 glue，但不是主要 insight；灵敏度分析是实验设计亮点，不是控制机制本身。性能提升很可能部分来自更合理的 effective gain scheduling 和充分 tuning，但不是纯 scaling，也不是靠更多算力。它更像是 better inductive bias + 在线低维 adaptation。

需要注意，AQSMC 的优越性并不等同于它准确识别了扰动。它没有 observer，也没有显式估计风场或模型误差；它只是用滑模误差作为 proxy 调整鲁棒项。因此所谓 adaptive robustness 更接近 error-triggered gain modulation，而不是系统辨识。

Relation To Prior Work

这篇属于 classical nonlinear / sliding-mode quadrotor control 谱系，不是 NMPC/RL 那条路线。最接近的是三类工作：Euler-angle SMC、SO(3) geometric controller / robust geometric controller、quaternion-based SMC 或 quaternion PD。

和 Euler-SMC 的本质差异是建模层面的：本文不把旋转动力学简化为小角度下的三个二阶通道，因此在大 roll/pitch 下不靠模型谎言维持控制律形式。很多 Euler-SMC 的高级变体，比如 terminal/fixed-time/fuzzy/HOSMC，可能在滑模收敛性质上更花哨，但如果底层 rotational dynamics 近似失效，aggressive flight 中优势有限。

和 GTC 的差异是误差收敛机制和鲁棒项。GTC 在 SE(3) 上坐标自由，工程上成熟，但通常是 PD/Lyapunov 型，抗扰主要靠增益与模型项；本文把 SMC 的鲁棒项同时放入位置和姿态，并且在 quaternion cover 上解决 unwinding，目标不是几何优雅，而是强扰动下的 tracking margin。

和已有 quaternion controller 的差异是：它不是简单用 quaternion 替代 Euler，而是把 unwinding-free sign choice、非光滑稳定性、6-DOF SMC 集成和 adaptive gain 放在一起。单看每个思想都不是凭空出现：sgn correction 在 quaternion 控制里常见，tanh boundary layer 在 SMC 里常见，自适应切换增益也常见。实质创新在于把这些组合成一个可证明、可上机、且针对旧 adaptive SMC gain overgrowth 明确修正的框架。

Dataset / Evaluation

评估质量在控制论文里算强。它不是只给仿真或单一轨迹，而是在真实 Crazyflie 2.1 上做了隔离姿态控制、自由飞行轨迹跟踪、风扰、throw launch 和 flip recovery。gimbal 实验尤其有价值，因为它把姿态环从位置环中拆出来，能直接暴露 Euler-SMC 大姿态建模缺陷。

benchmark 选择基本合理：ESMC 检验小角度滑模路线，GTC 检验主流 geometric nonlinear controller，QPD 检验 quaternion 姿态误差但非滑模内环的替代方案。作者还做了参数 ±20% sensitivity analysis，这一点比很多 nonlinear control work 更可信，因为它承认 tuning 是巨大混杂因素。

但 evaluation 仍有边界。平台只有一个 32g nano quadrotor，结论对更大机体、高速气动效应明显的平台是否保持不确定。风扰和 throw launch 虽然真实，但不是完全标准化的 disturbance characterization；throw launch 定量可比性弱。DF-INDI/RGTC 因实现或适配问题被排除，合理但也意味着和最强现代 agile flight stack 的正面对比不足。

Limitation

第一，理论保证是 UUB，不是严格全局渐近收敛；tanh 边界层和 adaptive threshold 决定了最终误差邻域。论文可以说全局有界，但不能过度解读为任意精确 tracking。

第二，成立依赖若干强前提：参考轨迹需要足够高阶光滑，kappa 必须保持非零，扰动和不确定性有界，电机能实现所需 thrust/moment。真实 aggressive flight 中 actuator saturation、battery sag、propeller aerodynamics、ground effect 等都可能破坏这些假设，文中没有系统纳入证明。

第三，adaptive law 仍然是经验调参。epsilon、Gamma、K_th、mu 的选择虽然有实验建议，但没有形成从平台约束或扰动谱出发的设计准则。K_th 尤其关键：它既防止增益过低，也重新引入了人工鲁棒裕度。增益来源不清，AQSMC 的收益可能部分来自 K_th 附近的更好 baseline gain，而非 adaptation 本身。

第四，非光滑 sign correction 在理论上处理了 q_we=0，但实际系统有姿态估计噪声、离散采样和滤波延迟。高频穿越 q_we=0 是否会引发符号抖动或控制不连续，文中未充分说明。可能在实验轨迹中不严重，但这不是已完全关闭的问题。

第五，scalability 上限在于它仍是 cascaded controller。它没有显式处理长期约束、障碍物、未来 actuator saturation 或任务级 planning；对于复杂环境中的 agile navigation，它更适合作为低层 robust tracking controller，而不是完整 autonomy solution。

Takeaway

  • 1）对 aggressive quadrotor control，姿态表示不是形式问题，而是性能问题。
  • Euler-SMC 的小角度假设在大姿态下会成为结构性失败点。
  • 2）adaptive SMC 真正需要解决的不是“如何让增益变大”，而是“如何让增益会遗忘”。
  • 双向增减的 switching gain 是比传统 \dot{k}=\gamma|s| 更实用的方向。

一句话总结

这篇论文把 unwinding-free quaternion SMC 和可增可减的 adaptive switching gain 结合成一个可在纳米四旋翼真机上运行的 6-DOF 鲁棒控制框架，真正贡献在于用正确姿态几何和在线鲁棒增益调度修补了传统 SMC 在 aggressive flight 中的工程断点。