4. ROV运动学基础

ROV在水下的每一个动作，最终都可以拆解为“沿三个轴的平移”和“绕三个轴的旋转”这六种基本运动的组合。理解这套运动学语言，是读懂推进器布局、看懂操控手柄动作、判断ROV为什么不听使唤的前提。本节从坐标系定义出发，把六自由度、推进器布置和基本控制逻辑串成一条完整的认知链。

一、六自由度：把水下运动拆成六个独立量

ROV在三维空间中的运动状态用六个自由度（Degree of Freedom，DOF）描述。平移三个：纵荡（Surge）沿前后方向、横荡（Sway）沿左右方向、升沉（Heave）沿上下方向；旋转三个：横滚（Roll）绕前后轴、俯仰（Pitch）绕左右轴、偏航（Yaw）绕上下轴。前三个改变ROV的位置，后三个改变ROV的姿态。

这里必须先固定一套坐标系约定，否则后续所有方向描述都会混乱。本课程采用ROV机体坐标系：原点取在ROV的几何中心（或设计重心附近），X轴指向机头正前方，Y轴指向机身右侧，Z轴指向机身正下方。按右手定则，绕X轴正转对应“右侧下沉”的横滚，绕Y轴正转对应“机头上抬”的俯仰，绕Z轴正转对应“机头向右”的偏航。全文与图示均以此为准，切换参照系时会明确说明。

需要区分的是，机体坐标系随ROV一起转动，而操作员看到的画面、声呐图像往往基于大地坐标系（北东地或当地水平面）。当ROV发生俯仰或横滚时，机体轴与大地轴不再重合，此时“手柄向前推”在机体上仍是Surge，但在大地坐标中可能同时包含水平和垂直分量。这是新手操控时最容易产生困惑的地方，也是自动定航、定深功能存在的意义。

二、推进器布局：用几个推力矢量凑出六个自由度

ROV的推进器数量与布局直接决定它能实现几个自由度。常见配置有三类：三推进器（两个水平斜置或平行布置负责Surge与Yaw，一个垂直负责Heave）、四推进器（两个水平、两个垂直，可做Surge、Heave、Yaw及部分Sway）、六推进器及以上（水平面四个呈矢量布置，垂直面两个，可完整实现六自由度全驱动）。

以常见的六推进器全驱动布局为例：四个水平推进器安装在机身四角，轴线与机身成约45°斜置，两两成对；两个垂直推进器左右对称布置。水平四推的合力逻辑是——同侧同向推产生Surge，对角同向推产生Yaw，左右两侧反向推产生Sway；垂直两推同向产生Heave，反向则产生Roll。Pitch通常由水平推进器的差动或专门的垂直前后布置实现，具体取决于设计。

这种布局的本质是推力矢量合成：每个推进器只产生沿自身轴线的推力，控制程序通过给不同推进器分配不同的推力比例，把操作员的一个运动指令“翻译”成一组电机转速。这就是推力分配矩阵（Thruster Allocation Matrix）的作用。理解这一点，就能明白为什么某个推进器故障后，ROV往往不是“少一个方向”，而是多个方向同时变弱或出现耦合。

三、基本运动控制逻辑：从手柄指令到推力分配

操作员推动手柄时，控制链路大致经过四步：手柄产生目标速度或目标姿态指令 → 飞控/主控读取当前姿态（来自IMU、深度计、罗盘）→ 控制器计算误差并输出各自由度的期望推力 → 推力分配矩阵把六维推力向量映射为每个推进器的PWM或转速指令。对于没有姿态闭环的入门级ROV，第三步简化为“手柄量直接映射为推力比例”，但分配矩阵这一步始终存在。

以一次“原地右转”为例说明分配过程。假设操作员只给Yaw正指令，Surge、Sway、Heave均为零。水平四推中，T1与T4同向、T2与T3反向，四推合力矩使机头向右旋转，而合力为零，因此ROV原地转动不产生平移。如果此时操作员同时给了一点Surge正指令，分配矩阵会把Yaw分量和Surge分量叠加到每个推进器上，T1、T4转速升高，T2、T3转速降低，ROV便一边前进一边右转。这就是多自由度耦合的直观表现。

实际调试时，可以用一个简单方法验证布局与方向是否正确：在岸上（或浅水可见处）逐个自由度单独给指令，观察ROV的实际响应是否与预期一致。例如给Heave正指令，ROV应整体上浮且不出现明显横滚；若上浮时伴随一侧先起，说明两个垂直推进器推力不一致或安装位置不对称。给Yaw正指令，机头应向右转且机身中心不漂移；若出现明显平移，说明对角推进器推力不匹配。这类“单自由度激励—观察响应”的检查，比直接下水做复杂动作更容易定位问题。

四、常见误区与判断依据

第一个误区是把“六自由度”等同于“六个推进器”。实际上三推、四推ROV也能实现部分六自由度运动，只是某些方向欠驱动或存在耦合，例如三推ROV通常无法独立控制Sway和Roll。第二个误区是忽略坐标系随姿态旋转。当ROV俯仰较大时，操作员看到的“前方”与机体X轴已经偏离，此时应借助姿态显示或定航功能修正，而不是凭感觉硬推。

判断ROV运动控制是否正常的依据可以归纳为三条：单自由度指令下，非目标方向的漂移应尽可能小；相同指令重复执行时，响应幅度应基本一致；姿态变化后，定深、定航功能应能把ROV拉回目标值。若某一条明显不满足，优先检查对应推进器的接线、安装角度和分配矩阵参数，而不是急于调整控制增益。