4. ROV运动控制原理与推进器分配

ROV在水下的每一个动作，最终都要落到“哪个推进器出多少推力”这件事上。操作员推动手柄时，控制计算机并不会直接命令某个推进器转多快，而是先把手柄信号解释成六自由度上的运动意图，再通过推力分配矩阵把这组意图拆解到各个推进器。理解这条链路，是判断ROV为什么“推了不走”“走偏了”或“某个方向特别软”的基础。

六自由度：先把“想怎么动”说清楚

ROV的运动用六个自由度描述，必须先在坐标系上达成一致，否则正负号会混乱。工程上通常采用机体坐标系：X轴指向ROV正前方，Y轴指向右舷，Z轴指向下方（也有采用Z向上的约定，本节统一采用Z向下）。在此基础上定义：

• 纵荡（Surge）：沿X轴前后平移，前进为正；
• 横荡（Sway）：沿Y轴左右平移，右移为正；
• 垂荡（Heave）：沿Z轴上下平移，下潜为正；
• 横滚（Roll）：绕X轴旋转，右舷下沉为正；
• 俯仰（Pitch）：绕Y轴旋转，艏部下沉为正；
• 艏摇（Yaw）：绕Z轴旋转，艏部右转为正。

这六个量构成一个六维速度（或力）向量 τ = [X, Y, Z, K, M, N]ᵀ，分别对应三个力和三个力矩。操作员的摇杆、自动定深、定艏向等控制器，输出的都是这个六维向量中的若干分量。需要强调的是，六自由度并非都能独立控制：多数作业型ROV没有独立的横滚、俯仰推进器，这两个自由度靠重心浮心配置被动稳定，控制器通常只对纵荡、横荡、垂荡、艏摇四个自由度做主动闭环，横滚俯仰仅做姿态监测与报警。

推进器布局决定可控性

推力分配的本质是几何问题。以常见的六推进器作业型ROV为例：两台垂向推进器左右对称布置在重心两侧，四台水平推进器呈矢量布置（艏部两台斜置、艉部两台斜置，或艏部两台横向、艉部两台纵向）。垂推负责垂荡与俯仰力矩，水平推进器组合出纵荡、横荡与艏摇。

布局直接决定“哪些方向推力富余、哪些方向先天不足”。例如艏部两台横向推进器间距小，产生艏摇力矩的力臂短，同样的推力下转向力矩偏弱；而矢量布置的水平推进器在纵荡和横荡之间共享推力，当同时要求大纵荡和大横荡时，各推进器会接近饱和，实际合速度方向偏离指令方向。这就是操作中“斜着走比直着走慢”的物理原因。

推力分配矩阵：从六维指令到n维推力

设ROV有n台推进器，第i台推进器位置为 rᵢ = (xᵢ, yᵢ, zᵢ)，推力方向单位向量为 dᵢ = (dxᵢ, dyᵢ, dzᵢ)，推力大小为 uᵢ。该推进器对六自由度的贡献为：

力：      Fᵢ = dᵢ · uᵢ
力矩：    Mᵢ = (rᵢ × dᵢ) · uᵢ

把所有推进器按列拼起来，得到分配矩阵 T（6×n）：
T = [ d₁  d₂ ... dₙ
      r₁×d₁  r₂×d₂ ... rₙ×dₙ ]

控制目标：  T · u = τ
求解推力：  u = T⁺ · τ   （T⁺ 为伪逆，n>6 时取最小范数解）

以一台艏部斜置推进器为例，若其位置为 (0.4, 0.3, 0)（单位米），推力方向为 (0.707, -0.707, 0)（朝右后方推），则它对纵荡贡献 0.707u、对横荡贡献 -0.707u，对艏摇的力矩为 x·Fy - y·Fx = 0.4×(-0.707u) - 0.3×0.707u ≈ -0.495u。把这些列向量组装成矩阵后，伪逆求解就能在给定六维指令时给出各推进器应输出的推力。实际控制器还会对解做二次优化，在满足合力的前提下尽量均衡各推进器负载、避开饱和。

死区与饱和：让指令“可执行”

摇杆回中时存在机械与电气噪声，若不加处理，ROV会持续收到微小推力指令而缓慢漂移。死区处理的做法是：对每个自由度的指令设定阈值（例如摇杆行程的3%～5%），绝对值低于阈值时置零，高于阈值时做平滑过渡（如减去阈值后重新映射到0～1），避免在阈值边缘产生跳变。

饱和处理则针对推进器物理极限。当伪逆解出的某台推进器推力超过其最大推力 u_max 时，直接截断会破坏合力方向。更合理的做法是整体缩放：求出所有推进器中 |uᵢ|/u_max 的最大比值k，若k>1，则把全部推力除以k。这样合力方向保持不变，只是整体推力按比例减小，操作员感受到的是“这个方向推不动那么快”，而不是“ROV突然拐弯”。

一个典型的调参顺序是：先确认坐标系与正负号，再核对分配矩阵中每台推进器的位置和方向是否与实际安装一致，然后设定死区阈值，最后验证饱和缩放。若发现ROV在纯艏摇指令下同时出现明显横移，多半是某台水平推进器的方向向量符号写反了，应回到分配矩阵逐列检查。

指令到输出的完整链路

把上述环节串起来：操作员摇杆产生归一化指令 → 控制器叠加定深、定艏向的闭环修正 → 得到六维力/力矩指令τ → 死区处理滤除微小分量 → 分配矩阵伪逆求解各推进器推力 → 饱和缩放保证不超限 → 输出PWM或转速指令给驱动器。任何一环的参数错误，都会表现为水下运动与操作意图不一致。排查时按链路从后往前验证：先看单台推进器能否独立正反转，再看分配矩阵的列向量是否与实测推力方向吻合，最后检查死区与缩放是否引入偏差。

掌握这条链路后，操作员面对“ROV不听话”时就有了判断依据：是意图没生成、分配算错了，还是推进器已经到极限。多数所谓“控制手感问题”，最终都能在分配矩阵的符号、死区阈值或饱和策略上找到原因。