4. 协同定位系统架构与通信拓扑

多无人机协同定位的核心问题，不只是“每架无人机如何估计自身位置”，而是“位置信息、观测信息和协方差信息在机间如何流动、由谁融合、以什么代价融合”。架构决定了计算与融合发生在哪里，通信拓扑决定了信息能以多快、多可靠地到达那里，两者共同决定了协同定位的精度上限、实时性和鲁棒性。本节从三种典型架构出发，分析其信息流与适用条件，再讨论链路约束和拓扑结构对定位性能的具体影响。

一、集中式架构：全局最优但依赖中心节点

集中式架构中，各无人机将本机的观测数据（如GNSS伪距、UWB测距、视觉特征、IMU预积分量）通过通信链路上传至一个中心节点——可以是地面站，也可以是编队中的某一架“领航机”。中心节点运行统一的滤波器或优化器，例如集中式扩展卡尔曼滤波（EKF）或因子图优化，得到全局一致的状态估计，再把结果下发。

其优势在于：所有观测在同一时刻、同一状态向量下联合处理，互协方差被显式建模，理论上可达到接近最优的估计精度；不存在分布式架构中因信息重复使用导致的“一致性偏差”。代价是中心节点计算与通信负担随无人机数量增长而迅速上升，且一旦中心节点失效或链路中断，整个协同定位可能降级甚至瘫痪。

设编队有 N 架无人机，状态维数为 n，集中式EKF的协方差矩阵规模为 nN×nN。当 N=6、单机状态取位置、速度、姿态共15维时，协方差矩阵已达90×90，每次更新涉及矩阵求逆，计算量不可忽略。因此集中式更适合小规模编队、地面站算力充足、链路带宽有保障的场景。

二、分布式架构：局部融合与一致性协同

分布式架构中，每架无人机只与通信范围内的邻居交换信息，各自维护局部状态估计。典型方法包括分布式卡尔曼滤波、协方差交叉（CI）、以及基于一致性的分布式优化。以协方差交叉为例，两机交换估计与协方差后，按下式融合：

P_fused^-1 = ω·P_a^-1 + (1-ω)·P_b^-1
x_fused = P_fused·(ω·P_a^-1·x_a + (1-ω)·P_b^-1·x_b)
ω ∈ [0,1] 由最小化融合后协方差迹确定

CI不要求知道两机估计之间的相关性，因此天然适合通信受限、无法传递完整互协方差的场景，代价是结果偏保守（协方差被高估）。分布式架构的可扩展性好、单点故障影响小，但信息需要多跳传播才能覆盖全网，收敛速度受拓扑连通度和通信频率制约。

三、混合式架构：分层融合的折中

混合式架构将编队划分为若干簇，簇内采用分布式融合，簇间由簇头节点进行集中式融合或一致性协调。它兼顾了集中式的高精度和分布式的鲁棒性，适合中等规模、任务分区明确的编队。例如侦察任务中，同一区域内的3～4架无人机组成一簇，簇内共享视觉与UWB观测，簇头再与相邻簇交换压缩后的估计结果。

四、通信链路约束：带宽、延迟与丢包

协同定位对通信的依赖体现在三个维度。第一是带宽：传递原始观测（如图像特征、完整协方差矩阵）所需带宽远高于传递压缩后的状态估计。以UWB测距为例，一次测距结果仅需几个字节，但若传递完整的互协方差矩阵，N=6时单次可达数十KB。第二是延迟：集中式架构中，所有节点等待中心节点返回融合结果，链路延迟直接进入定位环路，若延迟超过滤波器预测步长，状态估计会出现明显滞后。第三是丢包：分布式一致性算法通常假设邻居信息按周期到达，丢包会导致信息陈旧，CI融合时若误用过期协方差，可能产生过度乐观的估计。

工程上常用“通信预算”来约束设计：设定位更新周期为T=100ms，单机每周期可发送的字节数为B，则需保证B≥（状态估计字节数+协方差压缩字节数）×邻居数。若B不足，应优先传递对角协方差或采用事件触发通信，仅在估计变化超过阈值时才发送。

五、拓扑结构如何影响定位精度

拓扑对定位的影响可从“信息传播速度”和“几何观测条件”两方面理解。全连通拓扑下，任意两机可直接交换信息，一致性收敛最快，协同定位精度接近集中式；链式拓扑中，信息需多跳转发，末端节点获得邻居信息的时间滞后，若编队快速机动，滞后信息可能引入偏差。星型拓扑延迟低，但中心节点一旦丢失，整个网络退化为孤立节点。

更隐蔽的影响来自几何构型：协同定位依赖机间测距或视觉观测，若拓扑导致某些方向的观测缺失（例如链式编队中首尾之间无直接测距），则沿链路方向的定位误差无法被有效约束，协方差在该方向上持续增大。因此，拓扑设计不仅要考虑连通性，还要考虑观测几何的均匀性。

六、架构选择与降级策略

实际系统中，架构并非一成不变。一种常见的做法是：正常状态下采用混合式架构，簇内分布式融合、簇间集中式协调；当中心节点链路质量下降时，自动切换为纯分布式一致性融合，牺牲部分精度换取鲁棒性；当链路完全中断时，各机退回单机惯性/视觉里程计，仅依靠自身传感器维持短时定位，待链路恢复后再进行地图与状态对齐。

判断是否降级可依据链路质量指标，例如接收信号强度指示（RSSI）低于阈值、连续丢包数超过3个周期、或端到端延迟超过更新周期的2倍。降级策略应提前在软件中实现并经过仿真验证，避免飞行中临时决策。

总结来看，架构决定“谁融合”，拓扑决定“信息怎么到”，链路约束决定“能传多少、多快、多可靠”。三者共同构成协同定位的系统级设计空间。选择时先明确任务对精度、实时性和鲁棒性的优先级，再据此匹配架构与拓扑，最后用链路预算和可观测度分析验证方案是否可行。