2. ROV姿态动力学基础

在开始整定PID之前，必须先回答一个更基础的问题：控制器到底在控制什么？对ROV而言，答案不是"深度"或"航向"这类直观量，而是刚体在三维空间中的六个运动分量。姿态控制只负责其中三个转动分量，但转动与平动通过坐标系和动力学方程耦合在一起。如果对这套描述体系没有统一约定，后续整定中出现的符号错误、反馈方向反接、增益量纲混乱几乎都源于此。

刚体六自由度：三个平动与三个转动

把ROV视为刚体，其运动可用六个独立变量完整描述。平动沿三个正交轴：纵荡（surge，沿艇体纵轴前后）、横荡（sway，沿横轴左右）、垂荡（heave，沿垂向上下）。转动绕三个正交轴：横滚（roll，绕纵轴）、俯仰（pitch，绕横轴）、偏航（yaw，绕垂向轴）。工程上常用向量 η = [x, y, z, φ, θ, ψ]ᵀ 表示位置与姿态，用 ν = [u, v, w, p, q, r]ᵀ 表示对应的线速度与角速度。

需要强调的是，姿态控制直接作用的是 φ、θ、ψ 三个角度，而执行器（推进器）产生的是力与力矩。控制器输出的是力矩指令，经推力分配后变成各推进器转速，再通过水动力作用改变角速度，最终积分成角度。这条链条上任何一环的符号或量纲出错，PID都会表现为"越调越振"或"始终有静差"。

姿态角的定义与正负约定

本课程统一采用右手坐标系与右手定则：拇指指向某轴正方向，四指弯曲方向即为绕该轴旋转的正方向。具体约定如下，全文及图示保持一致：

• 横滚 φ：绕艇体纵轴（x轴）旋转，右舷下沉为正。
• 俯仰 θ：绕艇体横轴（y轴）旋转，艇首上抬为正。
• 偏航 ψ：绕艇体垂向轴（z轴）旋转，艇首向右（顺时针俯视）为正。

姿态角存在奇异点问题：当俯仰角接近 ±90° 时，欧拉角描述出现万向节死锁，横滚与偏航不再独立。ROV作业中俯仰通常不超过 ±45°，因此欧拉角足够使用；但若做翻滚类特技动作或大角度姿态保持，应改用四元数描述，这一点在后续姿态解算章节会展开。

坐标系转换：艇体系与地理系

ROV上同时存在两套常用坐标系。地理系（NED：北-东-下）固定于大地，用于描述ROV的绝对位置与航向；艇体系固定于机体，用于描述传感器读数与推进器作用方向。两者之间的转换由旋转矩阵 R 完成，按 Z-Y-X 顺序（先偏航、再俯仰、后横滚）有：

R = Rz(ψ)·Ry(θ)·Rx(φ)

线速度转换：  η̇_平动 = R · [u, v, w]ᵀ
角速度转换：  [φ̇, θ̇, ψ̇]ᵀ = T(φ,θ) · [p, q, r]ᵀ

其中 T 矩阵在 θ 较小时近似为单位阵，
即 φ̇≈p, θ̇≈q, ψ̇≈r。

这个近似非常关键：在小角度姿态控制中，可以认为艇体角速度直接等于欧拉角变化率，PID的微分项因此可以直接用陀螺仪读数。但当俯仰超过约20°时，T矩阵的非对角项不可忽略，此时若仍用 p、q、r 直接作为 φ̇、θ̇、ψ̇，微分反馈会产生交叉耦合，表现为横滚通道受偏航影响而抖动。

姿态动力学方程的简化形式

完整刚体动力学方程包含惯性矩阵、科氏力、水动力阻尼、浮力与重力恢复力矩等项，直接用于PID整定过于复杂。工程上通常做如下简化，得到每个姿态通道近似独立的二阶模型：

I·ω̇ + D·ω + G(η) = τ

其中：
I  —— 转动惯量（含附加质量），对角近似
D  —— 水动力阻尼系数，低速下以线性项为主
G  —— 恢复力矩（浮心与重心不重合产生）
τ  —— 推进器合力矩

单通道近似（以横滚为例）：
I_φ·φ̈ + D_φ·φ̇ + K_φ·φ = τ_φ

这个二阶形式是后续所有整定方法的出发点。它告诉我们三件事：第一，系统本质是二阶惯性环节，纯比例控制必然存在稳态误差；第二，阻尼项 D 随速度变化，低速时阻尼小、系统更"活"，高速时阻尼大、响应变"钝"，因此同一组PID在不同工况下表现不同；第三，恢复力矩 G 对横滚和俯仰是天然的自稳项（浮心高于重心时），对偏航则几乎为零，这解释了为什么偏航通道通常最难稳定、最容易漂移。

从方程到整定：三个必须确认的工程事实

以一台典型作业型ROV为例（示例参数，非实测）：横滚转动惯量约 8 kg·m²，线性阻尼系数约 12 N·m·s/rad，恢复力矩刚度约 25 N·m/rad。代入二阶模型可估算无阻尼自然频率 ωn ≈ √(25/8) ≈ 1.77 rad/s，阻尼比 ζ ≈ 12/(2√(8×25)) ≈ 0.42，属于欠阻尼系统，阶跃响应会有约 24% 的超调。这意味着即使不加控制，横滚受到扰动后也会以约 3.5 秒周期摆动数次才衰减——这正是整定时需要观察的"基线行为"。

整定前应确认三件事：其一，陀螺仪与姿态解算输出的正方向是否与上述约定一致，可用手动倾斜艇体观察角度符号来验证；其二，推进器产生的力矩方向是否与角度正方向匹配，避免反馈极性反接；其三，控制周期是否远小于系统最快时间常数，一般要求至少 10 倍以上，即控制周期不大于 50 ms。这三点确认完毕，PID整定才有意义；否则调参只是在错误的符号和量纲上反复试错。