二、系统建模：单推进器动力学模型、多推进器耦合模型、通信拓扑图论基础
做分布式推进协同控制，第一步不是写代码，而是建模。我见过太多团队上来就调参数，结果系统跑起来乱成一锅粥。说白了，模型就是你对物理世界的理解，理解错了，后面全白搭。
这一章，我们聊聊三个核心问题：单个推进器怎么动？多个推进器怎么互相影响？它们之间怎么通信？
2.1 单推进器动力学模型
先看最简单的——一个推进器在水里转。嗯，这里要注意，我们说的“推进器”不一定是螺旋桨，也可能是喷水推进器或者舵桨。但不管哪种，核心动力学方程都差不多。
我个人习惯把单推进器模型写成这样：
J * ω_dot = τ_m - τ_load - b * ω其中：
- J —— 转动惯量，包含电机转子和桨叶的惯性
- ω_dot —— 角加速度
- τ_m —— 电机输出的电磁转矩
- τ_load —— 水动力负载转矩
- b —— 粘性阻尼系数
- ω —— 当前角速度
你想想看，这个方程其实就是一个“力平衡”。电机使劲转，水阻力往回拽，阻尼在中间和稀泥。我在项目中遇到过一种情况：阻尼系数b设得太小，结果推进器在低速时疯狂振荡，像得了帕金森一样。
关键参数速查表：
| 参数 | 物理意义 | 典型取值范围 |
|---|---|---|
| J | 转动惯量 (kg·m²) | 0.01 ~ 10 |
| b | 阻尼系数 (N·m·s/rad) | 0.001 ~ 0.5 |
| τ_load | 负载转矩 (N·m) | 与转速平方成正比 |
水动力负载τ_load不是常数。它跟转速的平方成正比，公式是：
τ_load = K_q * ρ * D^5 * ω^2这里K_q是转矩系数，ρ是流体密度，D是桨叶直径。说白了，转速越快，阻力增长得越猛。我刚开始做仿真时，把τ_load设成了常数，结果模型跟实际差了30%以上。后来才意识到，这个非线性项是必须考虑的。
小技巧： 做仿真时，先把阻尼系数b设成0，看看系统是否稳定。如果无阻尼都振荡，那肯定是你转动惯量J算错了。
2.2 多推进器耦合模型
单个推进器搞明白了，接下来就是多个推进器一起工作。这时候问题就来了——它们之间会互相干扰。
举个例子，一艘船装了四个推进器，左前和右后同时加速，船会怎么动？答案是：不仅会前进，还会产生一个偏航力矩。这就是耦合效应。
多推进器耦合模型可以用一个矩阵来表示：
τ_total = B * u其中：
- τ_total —— 作用在载体上的合力/力矩向量（通常6维：3个力 + 3个力矩）
- B —— 推进器配置矩阵（也叫推力分配矩阵）
- u —— 各推进器的推力/转矩向量
B矩阵的每一列，代表一个推进器对载体产生的力和力矩。比如一个推进器装在船尾右侧，它产生的力会分解到x方向、y方向，还会产生一个绕z轴的力矩。
一个典型的4推进器配置矩阵：
B = [ 1 1 1 1 ; % x方向力
0 0 0 0 ; % y方向力
0 0 0 0 ; % z方向力
0 0 0 0 ; % 横摇力矩
0 0 0 0 ; % 纵摇力矩
-l -l l l ] % 偏航力矩这里l是推进器到重心的距离。注意，这个矩阵是高度耦合的——改变一个推进器的推力，会影响多个自由度。
我曾经在一个项目中，因为B矩阵写错了一个符号，导致船在直航时自动转圈。排查了整整两天，最后发现是某个推进器的安装方向标反了。嗯，这种低级错误，犯过一次就再也不会忘了。
避坑指南： 我曾经把推进器的安装角度搞混，结果仿真时船像陀螺一样原地打转。记住：B矩阵的符号取决于推进器的安装方向和位置，一定要跟机械图纸一一对应。
2.3 通信拓扑图论基础
模型建好了，接下来要考虑的是：多个推进器之间怎么交换信息？
分布式系统里，每个推进器都是一个智能节点。它们需要知道邻居的状态，才能协同工作。这就引出了图论。
我个人习惯用有向图来描述通信拓扑：
- 节点 —— 每个推进器控制器是一个节点
- 边 —— 如果节点i能收到节点j的信息，就有一条从j指向i的边
- 邻接矩阵A —— A_ij = 1表示j能向i发送信息
- 拉普拉斯矩阵L —— L = D - A，其中D是度矩阵
你想想看，拉普拉斯矩阵L有一个非常重要的性质：它的第二小特征值λ₂，决定了整个系统的收敛速度。λ₂越大，信息传播越快，协同控制收敛得也越快。
通信拓扑的核心概念：
| 概念 | 定义 | 工程意义 |
|---|---|---|
| 连通性 | 任意两个节点之间都有路径 | 系统能达成一致 |
| 代数连通度 | 拉普拉斯矩阵的第二小特征值λ₂ | 收敛速度的度量 |
| 入度/出度 | 节点接收/发送信息的邻居数 | 通信负载和鲁棒性 |
下面这张图，是我做项目时常用的几种通信拓扑结构。你可以直观地看到，不同的连接方式，对系统性能影响很大。
为什么图论这么重要？因为分布式协同控制的本质，就是让每个节点根据邻居的信息，调整自己的行为，最终达成全局一致。而通信拓扑决定了信息流动的速度和方向。
实用建议： 设计通信拓扑时，优先保证连通性。如果某个节点掉线了，系统还能不能工作？这就是鲁棒性问题。我一般会在关键节点之间加一条备用链路，成本不高，但可靠性提升一大截。
好了，模型部分就聊到这里。记住三件事：单推进器模型要包含非线性负载，多推进器耦合要用B矩阵描述，通信拓扑决定了协同控制的性能上限。这三块地基打牢了，后面调参数才有意义。
公众号:蓝海资料掘金营，微信deep3321