4. 刚体运动学与动力学
云台稳定问题，本质上是一个刚体在三维空间中的姿态控制问题。要让相机在机体剧烈运动时仍保持指向稳定，必须同时回答两件事：姿态如何变化（运动学），以及为什么这样变化（动力学）。前者描述角速度、角加速度与姿态角之间的几何关系，后者揭示力矩、转动惯量与角运动之间的因果链条。只有把这两层打通，云台控制器才不是“凭经验调参”，而是有物理依据的工程设计。
一、核心原理：从角速度到牛顿-欧拉方程
刚体姿态通常用旋转矩阵、四元数或欧拉角描述。工程中最直观的是欧拉角，但欧拉角速度与机体角速度并不相等，二者通过一个与当前姿态相关的变换矩阵联系。设欧拉角为滚转 φ、俯仰 θ、偏航 ψ，机体角速度为 ω = [p, q, r]ᵀ，则运动学关系可写为：
φ̇ = p + q·sinφ·tanθ + r·cosφ·tanθ
θ̇ = q·cosφ − r·sinφ
ψ̇ = q·sinφ/cosθ + r·cosφ/cosθ当俯仰角 θ 接近 ±90° 时，tanθ 与 1/cosθ 发散，这就是欧拉角奇异性。云台在垂直俯拍或大角度机动时容易遇到该问题，因此实际飞控与云台固件内部多采用四元数或旋转矩阵做姿态传播，仅在显示与调参时转换为欧拉角。
动力学层面，刚体绕质心的转动由牛顿-欧拉方程描述：
M = I·ω̇ + ω × (I·ω)其中 M 为合外力矩，I 为转动惯量矩阵，ω̇ 为角加速度，ω × (I·ω) 为陀螺项。该式说明：即使外力矩为零，只要存在角速度且转动惯量各轴不等，刚体也会产生耦合角加速度。云台三轴电机正是通过输出力矩来抵消这些耦合项与外部扰动，使相机轴保持惯性稳定。
二、方法流程：云台动力学建模步骤
- 定义坐标系：建立机体坐标系、云台基座坐标系与相机负载坐标系，明确各轴指向与旋转顺序。
- 参数辨识：测量或估算各轴转动惯量 Ixx、Iyy、Izz，以及电机力矩常数、减速比、摩擦系数。
- 建立运动学模型：写出欧拉角速度与机体角速度的变换关系，或直接采用四元数微分方程。
- 建立动力学模型：对每个旋转轴列写牛顿-欧拉方程，加入电机力矩、阻尼力矩、重力矩与线缆扰动力矩。
- 线性化与解耦：在工作点附近线性化，分析三轴耦合强度，设计前馈补偿与反馈控制律。
- 仿真与验证：用阶跃、正弦扫频和实测飞行数据验证模型，修正惯量与摩擦参数。
下面这张图展示了云台从机体扰动到相机姿态稳定的信号与力矩传递关系，是本节动力学建模的核心结构：
三、案例场景：三轴云台俯仰轴建模
以典型三轴云台俯仰轴为例，负载为相机与俯仰臂，绕俯仰轴转动惯量约为 Iyy = 0.0025 kg·m²。若要求俯仰角加速度达到 20 rad/s²，则所需电机力矩至少为：
M = Iyy · ω̇ = 0.0025 × 20 = 0.05 N·m这还未计入重力矩与摩擦。当相机重心偏离转轴 5 mm、质量 0.3 kg 时，重力矩最大可达 0.3 × 9.8 × 0.005 ≈ 0.0147 N·m，约占所需力矩的 30%。因此俯仰轴电机选型必须留出足够余量，并在控制中加入重力前馈。若忽略该力矩，云台在俯仰大角度时会出现明显下垂或振荡。
四、误区与复盘
- 误区一：把欧拉角速度当作机体角速度。 在大俯仰角下二者差异巨大，直接混用会导致姿态解算发散。
- 误区二：忽略陀螺耦合项。 高速偏航时，俯仰与滚转轴会感受到明显耦合，若控制器未解耦，画面会出现周期性抖动。
- 误区三：转动惯量用理论值不校正。 线缆、接插件、相机重心偏移都会改变实际惯量，必须通过扫频或阶跃响应辨识修正。
- 误区四：只调 PID 不建模型。 没有动力学模型，前馈与解耦无从谈起，参数只能在小范围内“试凑”，鲁棒性差。
| 物理量 | 符号 | 典型单位 | 在云台中的作用 |
|---|---|---|---|
| 角速度 | ω | rad/s | 描述姿态变化快慢，陀螺仪直接测量 |
| 角加速度 | ω̇ | rad/s² | 决定电机力矩需求与动态响应 |
| 力矩 | M | N·m | 电机输出，克服惯量、重力与摩擦 |
| 转动惯量 | I | kg·m² | 衡量负载抵抗角加速度的能力 |
| 陀螺耦合项 | ω×(I·ω) | N·m | 引起三轴交叉耦合，需前馈补偿 |
复盘来看，云台动力学建模的价值不在于写出多复杂的方程，而在于把“电机力矩—角加速度—姿态变化—相机指向”这条链路量化。只有明确每个轴的惯量、力矩上限与耦合强度，才能在控制带宽、功耗与稳定性之间做出合理取舍，让云台在真实飞行中既稳又准。