2025-11-11T10:13:09.504338

Geometric Tracking Control of Omnidirectional Multirotors for Aggressive Maneuvers

Lee, Cheng, Wu et al.
An omnidirectional multirotor has the maneuverability of decoupled translational and rotational motions, superseding the traditional multirotors' motion capability. Such maneuverability is achieved due to the ability of the omnidirectional multirotor to frequently alter the thrust amplitude and direction. In doing so, the rotors' settling time, which is induced by inherent rotor dynamics, significantly affects the omnidirectional multirotor's tracking performance, especially in aggressive flights. To resolve this issue, we propose a novel tracking controller that takes the rotor dynamics into account and does not require additional rotor state measurement. This is achieved by integrating a linear rotor dynamics model into the vehicle's equations of motion and designing a PD controller to compensate for the effects introduced by rotor dynamics. We prove that the proposed controller yields almost global exponential stability. The proposed controller is validated in experiments, where we demonstrate significantly improved tracking performance in multiple aggressive maneuvers compared with a baseline geometric PD controller.
academic

Geometric Tracking Control of Omnidirectional Multirotors for Aggressive Maneuvers

基本信息

  • 论文ID: 2209.10024
  • 标题: Geometric Tracking Control of Omnidirectional Multirotors for Aggressive Maneuvers
  • 作者: Hyungyu Lee, Sheng Cheng, Zhuohuan Wu, Jaeyoung Lim, Roland Siegwart, Naira Hovakimyan
  • 分类: cs.RO (机器人学), cs.SY (系统与控制), eess.SY (电气工程系统与控制)
  • 发表时间: 2022年9月首次提交，2025年1月更新
  • 论文链接: https://arxiv.org/abs/2209.10024

摘要

全向多旋翼飞行器具有解耦的平移和旋转运动机动能力，超越了传统多旋翼飞行器的运动能力。这种机动性是通过频繁改变推力幅度和方向来实现的。在此过程中，由固有旋翼动力学引起的旋翼稳定时间显著影响全向多旋翼飞行器的跟踪性能，特别是在激进飞行中。为了解决这个问题，本文提出了一种考虑旋翼动力学且不需要额外旋翼状态测量的新型跟踪控制器。通过将线性旋翼动力学模型集成到飞行器运动方程中，并设计PD控制器来补偿旋翼动力学引入的影响。作者证明了所提出的控制器具有几乎全局指数稳定性。实验验证表明，与基线几何PD控制器相比，该控制器在多种激进机动中显著改善了跟踪性能。

研究背景与动机

问题定义

  1. 核心问题: 全向多旋翼飞行器在执行激进机动时，旋翼动力学的稳定时间严重影响跟踪性能
  2. 技术挑战: 传统控制器假设旋翼具有理想的快速响应，忽略了旋翼动力学对系统性能的影响
  3. 实际需求: 在动态环境中，全向多旋翼需要频繁且精确地改变速度和方向，对控制精度要求极高

研究重要性

  • 全向多旋翼飞行器能够在任意姿态下产生抵消重力的推力，大大扩展了应用范围
  • 激进机动能力对于在动态环境中的操作至关重要
  • 现有方法缺乏对旋翼动力学的系统性考虑，限制了实际应用性能

现有方法局限性

  1. 忽略旋翼动力学: 大多数研究假设旋翼具有快速（因此可忽略）的动力学特性
  2. 需要额外传感器: 部分考虑旋翼动力学的方法需要专用传感器或特殊电调来测量旋翼状态
  3. 缺乏稳定性保证: 现有方法未提供严格的稳定性分析

核心贡献

  1. 首创性控制架构: 提出了首个考虑旋翼动力学且不需要额外旋翼状态测量的全向多旋翼控制器设计
  2. 理论保证: 证明了所提控制器在包含旋翼动力学的完整系统中具有几乎全局指数稳定性
  3. 实验验证: 使用八旋翼全向多旋翼平台验证了控制器在激进机动中的优越性能
  4. 通用性设计: 控制器适用于单向和双向旋翼系统

方法详解

任务定义

输入: 期望位置轨迹 pd(t)p_d(t)、期望姿态轨迹 Rd(t)R_d(t) 及其导数 输出: 旋翼推力指令 fcmdf_{cmd}约束: 考虑旋翼动力学影响下的轨迹跟踪控制

系统建模

旋翼动力学模型

采用推力动力学(TD)模型，将推力简化为一阶系统： fi˙=1αf,i(fcmd,i−fi)\dot{f_i} = \frac{1}{\alpha_{f,i}}(f_{cmd,i} - f_i)

其中 αf,i\alpha_{f,i} 为第i个旋翼的推力时间常数。

完整运动方程

考虑旋翼动力学后的Newton-Euler方程： mv˙=−αmv¨−αR(F×ω)−mgz^I+RFcmdm\dot{v} = -\alpha m\ddot{v} - \alpha R(F \times \omega) - mg\hat{z}_I + RF_{cmd}Jω˙=−α(ω˙×Jω+ω×Jω˙+Jω¨)−ω×Jω+McmdJ\dot{\omega} = -\alpha(\dot{\omega} \times J\omega + \omega \times J\dot{\omega} + J\ddot{\omega}) - \omega \times J\omega + M_{cmd}

控制器设计

平移控制器

定义误差：

  • 位置误差: ep=p−pde_p = p - p_d
  • 速度误差: ev=v−vde_v = v - v_d
  • 力误差: eF=F−Fde_F = F - F_d

控制律设计： Fcmd=Fd+αFd˙F_{cmd} = F_d + \alpha \dot{F_d}

其中期望力为： Fd=RT(−kpep−kvev+mgz^I+mvd˙)F_d = R^T(-k_p e_p - k_v e_v + mg\hat{z}_I + m\dot{v_d})

旋转控制器

定义误差：

  • 姿态误差: eR=12[RdTR−RTRd]∨/1+tr(RdTR)e_R = \frac{1}{2}[R_d^T R - R^T R_d]^{\vee}/\sqrt{1 + tr(R_d^T R)}
  • 角速度误差: eω=ω−RTRdωde_{\omega} = \omega - R^T R_d \omega_d
  • 力矩误差: eM=M−Mde_M = M - M_d

控制律设计： Mcmd=Md+αMd˙M_{cmd} = M_d + \alpha \dot{M_d}

技术创新点

  1. 补偿项设计: 通过 αFd˙\alpha\dot{F_d} 和 αMd˙\alpha\dot{M_d} 项主动补偿旋翼动力学引起的延迟
  2. 无需额外传感器: 利用IMU估计力和力矩误差，避免了专用旋翼状态传感器
  3. 几何控制框架: 在SO(3)流形上设计控制器，避免奇点问题
  4. 解耦设计: 平移和旋转控制器独立设计，简化了控制结构

实验设置

实验平台

  • 配置: 八旋翼固定倾斜双向旋翼全向多旋翼
  • 硬件: BrotherHobby LPD 2306.5 2000KV电机，Gemfan 513D三叶3D螺旋桨
  • 参数: 质量1.481kg，转动惯量J = diag(0.020, 0.021, 0.020) kg·m²
  • 旋翼时间常数: αf = 0.07s

实验设计

三个主要测试场景：

  1. 纯平移轨迹: 验证平移控制系统
  2. 单轴旋转轨迹: 验证旋转控制系统
  3. 多轴旋转轨迹: 验证复合运动控制

评价指标

  • 位置均方根误差(RMSE)
  • 姿态均方根误差(RMSE)
  • 跟踪精度对比

实验结果

主要结果

纯平移轨迹实验

  • 轨迹: xd(t)=−0.4cos⁡(4π3t)x_d(t) = -0.4\cos(\frac{4\pi}{3}t), yd(t)=0.4sin⁡(4π3t)y_d(t) = 0.4\sin(\frac{4\pi}{3}t), zd(t)=0.6z_d(t) = 0.6m
  • 结果: 所提方法位置RMSE比基线方法降低31%
  • 分析: 在x和y轴方向显著改善跟踪性能，z轴性能相当

单轴旋转轨迹实验

  • 轨迹: ωzB=π2sin⁡(2πt)\omega_z^B = \frac{\pi}{2}\sin(2\pi t) rad/s
  • 结果: 姿态RMSE比基线方法降低39%
  • 分析: 在高角加速度条件下显著改善姿态跟踪性能

多轴旋转轨迹实验

  • 轨迹: ωzB=2π\omega_z^B = 2\pi rad/s, ωyI(t)=π2sin⁡(πt)\omega_y^I(t) = \frac{\pi}{2}\sin(\pi t) rad/s
  • 结果: 姿态RMSE改善11%，位置跟踪显著改善
  • 分析: 验证了在复杂机动中的综合性能提升

关键发现

  1. 旋翼动力学影响: 在激进机动中，旋翼稳定时间是影响性能的主要因素
  2. 补偿效果: 所提方法有效补偿了由旋翼动力学引起的相位滞后
  3. 通用性: 方法对不同类型的激进机动都显示出改善效果

理论分析

稳定性证明

Lyapunov函数设计

平移系统: V1=12kp∥ep∥2+12m∥ev∥2+12α∥eF∥2+c1ep⋅evV_1 = \frac{1}{2}k_p\|e_p\|^2 + \frac{1}{2}m\|e_v\|^2 + \frac{1}{2}\alpha\|e_F\|^2 + c_1 e_p \cdot e_v

旋转系统:
V2=12eω⋅Jeω+kRΨ(R,Rd)+12α∥eM∥2+c2eR⋅eωV_2 = \frac{1}{2}e_{\omega} \cdot Je_{\omega} + k_R\Psi(R,R_d) + \frac{1}{2}\alpha\|e_M\|^2 + c_2 e_R \cdot e_{\omega}

稳定性条件

控制增益需满足： kp>c1kv2+2c1kv−c12m(4(kv−c1)−1),kv>c1+14k_p > \frac{c_1k_v^2 + 2c_1k_v - c_1^2}{m(4(k_v - c_1) - 1)}, \quad k_v > c_1 + \frac{1}{4}

kR>c2kω2λm(4(kω−12c2)−1),kω>12c2+14k_R > \frac{c_2k_{\omega}^2}{\lambda_m(4(k_{\omega} - \frac{1}{2}c_2) - 1)}, \quad k_{\omega} > \frac{1}{2}c_2 + \frac{1}{4}

主要定理

定理1: 在满足设计条件下，完整系统的跟踪误差动力学零平衡点是几乎全局指数稳定的。

相关工作

全向多旋翼发展

  • 单向旋翼系统: 需要至少7个旋翼或可变倾斜机构
  • 双向旋翼系统: 简化机械结构，但功率效率较低
  • 控制方法: 从几何PID到非线性MPC的演进

旋翼动力学建模

  • DCMD模型: 基于无刷直流电机动力学的精确模型
  • TD模型: 简化的推力动力学模型，平衡精度和复杂度
  • 应用: 在固定翼和四旋翼中的成功应用

结论与讨论

主要结论

  1. 成功设计了考虑旋翼动力学的全向多旋翼控制器
  2. 理论证明了几乎全局指数稳定性
  3. 实验验证了在激进机动中的显著性能改善
  4. 无需额外传感器的实用性设计

局限性

  1. 旋翼饱和: 当前设计未考虑旋翼饱和约束
  2. 反转延迟: 双向旋翼的反转延迟未建模
  3. 参数适应: 未考虑旋翼特性变化的鲁棒性

未来方向

  1. 约束优化: 通过约束最小二乘处理旋翼饱和
  2. 反转延迟建模: 特别针对双向旋翼的详细建模
  3. 鲁棒控制: 集成适应旋翼特性变化的鲁棒控制机制

深度评价

优点

  1. 理论严谨: 提供了完整的稳定性分析和证明
  2. 实用性强: 无需额外传感器，易于实际部署
  3. 实验充分: 三种不同类型的激进机动验证
  4. 创新性高: 首次在全向多旋翼中系统考虑旋翼动力学

不足

  1. 模型简化: TD模型相比DCMD模型存在精度损失
  2. 实验规模: 仅在一个平台上验证，缺乏多样性
  3. 环境限制: 实验在理想室内环境进行，缺乏外界干扰测试
  4. 计算复杂度: 未详细分析实时计算负担

影响力

  1. 学术贡献: 为全向多旋翼控制理论提供了新的视角
  2. 实用价值: 为激进机动应用提供了可行的解决方案
  3. 可复现性: 提供了详细的参数和实现细节
  4. 拓展性: 为后续研究提供了良好的理论基础

适用场景

  1. 搜索救援: 需要在复杂环境中执行激进机动
  2. 工业检测: 在狭窄空间中的精确定位和检测
  3. 科研平台: 作为研究全向飞行器控制的基础平台
  4. 娱乐表演: 需要复杂飞行轨迹的表演应用

参考文献

论文引用了34篇相关文献，涵盖了多旋翼建模与控制、全向飞行器设计、旋翼动力学建模等关键领域的重要工作，为本研究提供了坚实的理论基础。

总体评价: 这是一篇在全向多旋翼控制领域具有重要贡献的高质量论文，理论严谨，实验充分，具有较强的实用价值和学术影响力。