六旋翼单桨失效容错控制

当一个电机突然失效,六旋翼如何利用冗余自由度保持飞行?
交互式可视化帮你理清核心思路。

向下滚动
01标准六旋翼构型

6 个电机等间距 60° 排列,交替 CW/CCW 旋转。点击下方按钮模拟不同桨失效场景。

正常 · 6 桨运行

过驱动系统

6 个执行器控制 4 个自由度(T, τϕ, τθ, τψ),拥有 2 个冗余自由度——这正是容错的数学基础。

控制量

总升力 \(T\)、滚转力矩 \(\tau_\phi\)、俯仰力矩 \(\tau_\theta\)、偏航力矩 \(\tau_\psi\),四个通道共同维持姿态与位置。

02单桨失效后丢了什么?

假设 M1(CW)失效,立即产生三个问题:

🔻 升力缺口

最大推力从 \(6F_{\max}\) 降为 \(5F_{\max}\),悬停油门比从 ≈67% 升至 ≈80%,操控裕度被显著压缩。

⚖️ 滚转/俯仰不平衡

失效桨在特定方位的力矩贡献消失,剩余 5 桨不再天然对称,产生持续的力矩偏差。

🔄 偏航力矩失衡(最棘手)

CW 与 CCW 桨数变为 2:3,反扭矩天然失衡。平衡偏航需要"消耗"额外的推力裕度。

关键判定 剩余 5 执行器 > 4 自由度 → 冗余度 = 1 → 理论仍可控
但实际可控性取决于推力约束 \(0 \le F_i \le F_{\max}\) 和偏航补偿代价
03两种主流策略对比

停掉对桨 vs. 保留五桨重构混控——如何选择?

策略 A:停掉对桨
策略 B:5 桨重构 ★推荐

M1 失效 → 主动关闭 M4(对面电机) → 4 桨飞行

CW/CCW 数量恢复 2:2,反扭矩静态平衡。但最大推力仅剩 \(4F_{\max}\),悬停需要接近满油门,几乎没有操控余量。更关键的是——剩下 4 个桨构成的"虚拟四旋翼" 和标准四旋翼完全不同

⚠ 几何与旋向的"双重不对称"

停掉 M1、M4 后,剩下 M2、M3、M5、M6 排成一个 矩形(不是正方形):左右窄、前后宽。它们的旋向分布是:

CCW–CCW 同向 CW–CW 同向 M2 M3 M5 M6 M1✗ M4 停

这和标准 X 型四旋翼完全相反——标准四旋翼的相邻桨一定旋向相反、对角桨同向,所以"对角加速"就能产生纯偏航力矩、"前两个加速"就能产生纯俯仰力矩。但这里:

  • 前后边各是同旋向的"双胞胎"——前边 M6+M2 都是 CCW,后边 M5+M3 都是 CW。
  • 想俯仰必然引入偏航:要抬头就得让 M5+M3 增速,但它俩都是 CW,反扭矩同时增加,机体被迫向 CCW 方向偏航;要低头则反过来。τθτψ 在控制矩阵里强耦合。
  • 想偏航必然引入俯仰:要顺时针偏航得让 CW 桨(M3+M5)减速、CCW 桨(M2+M6)增速,但 CW 全在后、CCW 全在前——结果机头被抬起来。yaw 命令变成了 pitch 命令。
  • 滚转通道相对干净:左右两侧(M2+M3 vs M5+M6)每侧都各有一个 CW 一个 CCW,反扭矩自然抵消,所以单纯滚转还算解耦。

数学上看,4 个执行器恰好等于 4 个自由度,控制分配矩阵 B4 是方阵但 条件数极差——某些方向的指令需要电机出极大力才能实现,很容易饱和。这就是"几何上是四旋翼,控制上完全不是四旋翼"的根源。

🚨 更深一层:混控矩阵秩亏,根本不可控

把控制分配写成矩阵形式。设 4 个电机的转速增量为 \(\delta\omega_i\),按 M6、M2、M5、M3 顺序(左前、右前、左后、右后)排列:

控制分配 \[ \begin{bmatrix} T \\ \tau_{\text{roll}} \\ \tau_{\text{pitch}} \\ \tau_{\text{yaw}} \end{bmatrix} \propto \begin{bmatrix} +1 & +1 & +1 & +1 \\ +1 & -1 & +1 & -1 \\ +1 & +1 & -1 & -1 \\ +1 & +1 & -1 & -1 \end{bmatrix} \begin{bmatrix} \delta\omega_{M6} \\ \delta\omega_{M2} \\ \delta\omega_{M5} \\ \delta\omega_{M3} \end{bmatrix} \]

注意最后两行完全相同!俯仰行和偏航行一模一样,意味着 B4 的秩只有 3,而不是 4。这不是"耦合严重",而是"根本无法解耦"——飞控算法找不到任何一组电机转速能同时独立满足俯仰和偏航指令。

为什么两行会一样?对照看:

  • 俯仰指令(抬头)= 前排(M6+M2)增速 − 后排(M5+M3)减速
  • 偏航指令(CCW 自旋)= CCW 组(M6+M2)增速 − CW 组(M5+M3)减速
  • 因为前排恰好就是 CCW 组、后排恰好就是 CW 组,两个指令使用的电机差分组合完全相同,飞控无从区分。

对照标准 X 型四旋翼(对角同向):前左 CCW、前右 CW、后左 CW、后右 CCW。

  • 俯仰用"前排 vs 后排"差分——前排一 CW 一 CCW,反扭矩自动抵消,不影响偏航。
  • 偏航用"对角线"差分——对角同向所以反扭矩同号叠加,但对角的几何力臂相互抵消,不影响俯仰。
  • 混控矩阵秩 = 4,四个自由度完全解耦。

结论:停掉 M1+M4 后剩下的"虚拟四旋翼"是 欠驱动且不可完全控制 的——油门 ✓、滚转 ✓、俯仰 ✗、偏航 ✗。想抬头必然自旋,想偏航必然俯仰。这是一种根本性的控制缺陷,不是调参可以解决的问题。所以 策略 A 在 M1/M4 这种"两个 CW、两个 CCW 但前后分组"的对桨上其实不可行,必须停的是另一组对桨(例如 M2+M5 或 M3+M6),才能恢复标准 X 型的对角同向布局。

优势
  • 偏航自然平衡,无需持续补偿
  • 不会出现机体持续旋转
  • 混控逻辑相对简单
劣势
  • 推力损失 33%,裕度极小
  • 推重比需 ≥ 2.5 才安全
  • 俯仰 ↔ 偏航 强耦合(同旋向双胞胎)
  • 控制分配矩阵条件数差,易饱和

策略 B 的偏航处理路线

全自由度保持

伪逆分配同时控制 \(\phi, \theta, \psi, T\)。偏航代价大,少数方向的桨需加速,多数方向需减速,推力裕度小,机动时易饱和。

Relaxed Yaw ★

只控制 \(\phi, \theta, T\),允许 yaw 轴自由旋转。推力和姿态裕度大幅改善,GPS/光流仍可保持位置,安全降落完全可行。

04推力预算速算

推重比是容错能力的核心约束。拖动滑块查看不同推重比下的裕度。


指标6 桨正常5 桨(策略 B)4 桨(策略 A)
总最大推力 6Fmax 5Fmax 4Fmax
悬停油门比 16.7% 20.0% 25.0%
机动+偏航余量 充裕 中等 极小
安全判据 悬停油门比 ≤ 60%~65%,即 \(\dfrac{W}{n \cdot F_{\max}} \le 0.65\)

5 桨方案 → 推重比 ≥ 1.54(考虑偏航补偿,建议 ≥ 1.8
4 桨方案 → 推重比 ≥ 2.5 才比较安全
05工程实施流程

从故障检测到安全着陆的完整链路。

① 故障检测

监测电调反馈电流/转速,或用观测器估计各桨推力残差,判定失效桨编号。检测延迟目标 <100ms。

② 混控矩阵在线切换

预先为每个桨失效场景离线计算好 \(B_i^\dagger\)(6 种情况),故障确认后直接查表切换,无需在线求伪逆。

③ 偏航策略决策

推重比 ≥ 2 → 可尝试全自由度保持;推重比 1.5~2 → Relaxed Yaw,放弃航向锁定,仅保位置和姿态稳定。

④ 控制器增益切换

失效后等效惯量和力臂变化,PID/INDI 控制器增益需切换到预设的容错参数组。

⑤ 安全着陆

执行受控下降或返航降落,GPS/光流保持位置精度。Relaxed Yaw 下机体自旋但位置稳定。

06总结与建议

最优解:5 桨 + 重构混控 + Relaxed Yaw

对于大多数六旋翼平台,保留 5 桨 结合 混控矩阵重构Relaxed Yaw 是最优方案——推力利用率最高、学术和工程成熟度最高、安全边际最大。

只有在任务绝对要求航向锁定且推重比足够大(≥ 2.5)时,才考虑停对桨方案。设计阶段就应将整机推重比留到 ≥ 1.8,为容错留足空间。