简介这是一份关于基于凸优化的分布式目标定位技术研究的学术pdf文档适合无线传感器网络、信号处理及分布式优化方向的研究生、科研人员作为参考文献。资料从凸优化理论基础切入系统论述标准形式、最优解条件及拉格朗日对偶机制并重点讲解分布式ADMM算法如何将非凸最小二乘目标函数松弛为凸问题通过变量分解与迭代求解完成目标定位同时给出深海目标定位等应用场景的过程与算法步骤。此外还讨论了收敛速度、鲁棒性及低功耗策略等未来研究方向。压缩包内共1个PDF文件大小约96KB内容较完整地保留了摘要、关键词、公式推导与参考文献。文档已有143人浏览学习适合快速获取该研究脉络用于论文调研、课堂报告或课题起步参考。1. 凸优化与分布式目标定位这套组合到底解决谁的痛点早些年做多基站无源定位我最怕的不是测量噪声而是把最大似然目标函数扔进求解器之后十次初值有九次收敛到局部极小。问题本质在于定位方程里带两个范数相减目标函数天然非凸而当我们把节点从四个扩到二十个、从集中式处理换成分布式架构时连“把所有测量传到中心节点再算一次全局最优”这条路也走不通了。凸优化与分布式目标定位就是把这两件事一起解决先用半定松弛或二阶锥松弛把非凸定位改写成一个可全局求解的凸问题再用分布式 ADMM 把计算拆到每个节点上节点之间只交换低维中间变量最终收敛到和集中式基本一致的结果。适合做无线传感器网络定位、无人集群协同定位、多基地探测这类场景的工程师尤其是手里有实网数据、被集中式算力和通信瓶颈卡过的人。2. 从非凸到凸TDOA 建模、半定松弛与二阶锥松弛选型目标定位的观测量一般分四类TOA到达时间、TDOA到达时间差、RSS接收信号强度、AOA到达角度。工程里 TDOA 用得最多因为只要各接收站时间同步它天然消掉了目标发射时刻这个未知量不需要目标端配合。这章先把 TDOA 定位为什么非凸讲清楚再给出两条把它改写成凸问题的常见路线半定松弛和二阶锥松弛。2.1 TDOA 观测模型为什么最大似然是非凸的假设平面内有 N 个锚点基站坐标 s_i 已知目标真实位置 x 未知。以 1 号站为参考站对第 i 个站测量到达时间差折算成距离差$$ r_{i1} \lVert x - s_i \rVert - \lVert x - s_1 \rVert e_{i1} $$如果噪声服从高斯分布最大似然估计等价于加权最小二乘$$ \min_{x} \sum_{i2}^{N} w_i \left( \lVert x - s_i \rVert - \lVert x - s_1 \rVert - r_{i1} \right)^2 $$这里的问题一眼就能看出来两个欧几里得范数相减函数关于 x 是非凸的而且在所有锚点连线的延长线附近存在不可导点。直接上梯度下降、高斯牛顿或者 fmincon结果强烈依赖初值初值给到双曲线的错误支上迭代就跑到几何上完全错误的位置。更麻烦的是目标函数会有多个局部极小其中很多局部极小对应的残差并不大靠“多初值试一遍”在实时场景里根本不可接受。所以这条技术路线的基本逻辑是非凸问题不能硬解要找它的凸近似保证无论初值在哪求解器拿到的是同一个全局最优。2.2 半定松弛把二次等式扔掉换一个凸可行域TDOA 方程有一个经典的代数变形。设参考距离 r_1 \lVert x - s_1 \rVert把原始距离差等式两边同时加 r_1 再平方可以消掉根号得到关于未知向量 \theta [x; r_1] 的线性方程$$ 2(s_i - s_1)^\top x 2r_{i1} r_1 \lVert s_i \rVert^2 - \lVert s_1 \rVert^2 - r_{i1}^2 $$写成紧凑形式就是 A_i \theta b_i其中 A_i 是 1×3 的矩阵b_i 是标量。到这一步还是不够因为 \theta 内部有一个隐藏约束r_1 必须等于 \lVert x - s_1 \rVert也就是 \theta^\top C \theta c^\top \theta 0这是一个二次等式依然非凸。半定松弛的做法很直接令 Y \theta\theta^\top把二次约束变成关于 Y 和 \theta 的线性表达式然后用凸的半定约束 Y \succeq \theta\theta^\top等价于分块矩阵 [Y, \theta; \theta^\top, 1] 半正定去替代严格相等的秩一约束。丢掉“Y 的秩必须为 1”这个非凸条件之后问题就变成一个标准的半定规划$$ \min_{Y,\theta} \sum_{i2}^{N} w_i (A_i\theta - b_i)^2 \quad \text{s.t.} \quad \begin{bmatrix} Y \theta \ \theta^\top 1 \end{bmatrix} \succeq 0 $$解完之后检查 Y 的特征值如果最大特征值远大于第二特征值说明松弛是紧的\theta 的前两维就是目标位置如果秩一条件被打破定位结果会明显恶化。后面第 5 章专门讲这种情况的坑。2.3 二阶锥松弛实时定位场景的轻量替代半定松弛在锚点数少、噪声水平适中的时候精度很好但 SDP 的求解代价偏高尤其是节点数量上来之后求解器一轮内点迭代的矩阵分解开销会让人劝退。另一个常见替代是用二阶锥松弛。思路是把每个距离 \lVert x - s_i \rVert 替换成它的上界变量 t_i用 t_i - t_1 来拟合 TDOA 测量值约束写成$$ \lVert x - s_i \rVert \le t_i, \quad i 1,\dots,N $$这样目标函数变成 sum_i w_i (t_i - t_1 - r_{i1})^2可行域是凸的二阶锥求解速度比 SDP 快一个量级。代价是松弛后的解通常不在原始双曲线的交点上精度在低噪声场景下比 SDR 略差但实时性要求高的系统基本都选这条路。2.4 选型对照锚点数、噪声与算力怎么权衡维度半定松弛 SDR二阶锥松弛 SOCR建模难度需要引入 Y 和 PSD 约束推导稍重只需要引入 t_i 变量和范数锥求解速度慢节点多时内点迭代吃力快适合实时和嵌入式噪声鲁棒性高松弛更容易保持紧性中等高噪声下误差偏大锚点布局敏感锚点共线时仍会失效锚点共线时更明显典型场景离线标定、后处理、高精度定位在线定位、资源受限节点我自己的选型习惯是如果目标是做采集后的高精度分析、锚点数量不多优先试 SDR如果是无人集群实时协同定位直接上 SOCR ADMM精度不够再用 SDR 做参考解离线评估。工程上“先跑通、再提精度”比“一上来就追求理论上界”重要得多。3. 分布式求解架构用 ADMM 把定位拆到节点上就算把非凸定位松弛成凸问题集中式求解在真实分布式系统里依然不现实。这章讲清楚为什么要分布式以及 ADMM 怎么把全局凸问题拆成各个节点只用自己的测量、只跟邻居交换低维变量的迭代过程。3.1 集中式求解的三个卡点通信、算力、故障集中式定位的工作方式是每个节点把原始测量值时延差值、坐标、质量因子全部发到中心节点中心节点组装一个全局优化问题求解完再把目标位置广播回去。三个卡点都很现实。第一是通信负载。发的是带时间戳的原始测量不是中间变量随着锚点数量增长中心节点上行带宽很快就成为瓶颈。第二是算力。SDP 的变量维度在 2D 场景下就有 9 个Y 是 3×3 的对称阵锚点再多、还要做加权和去 NLOS 预处理时单节点算力扛不住。第三是单点故障。中心节点一掉全网定位直接全停。分布式架构的意义不是“看起来更高级”而是把通信量从原始测量降到低维中间变量把算力分摊到每个节点并且去掉中心依赖。3.2 问题分解一致性约束与增广拉格朗日上一章的凸松弛最终都能写成如下形式$$ \min_{\theta} \sum_{i1}^{N} f_i(\theta) $$其中 f_i(\theta) 是第 i 个节点基于本地锚点坐标和本地 TDOA 测量构造出来的代价函数\theta 是全局目标变量2D 定位时是 [x; r_1]三维向量3D 定位时是四维向量。每个节点都想算同一个 \theta但各自只掌握一部分数据。分布式 ADMM 的标准做法是给每个节点引入一个本地副本 \theta_i再通过一致性约束强制所有副本相等$$ \min_{\theta_i} \sum_{i1}^{N} f_i(\theta_i) \quad \text{s.t.} \quad \theta_i z, \ i 1,\dots,N $$这里 z 是全局的一致变量。写成增广拉格朗日形式就是每条约束后面挂一个对偶变量 u_i再给一致性偏差加一个二次惩罚项。这个二次惩罚项就是 ADMM 能收敛的关键它让每个节点在本地算自己的 \theta_i 时始终被“拉向”当前的全局 z。3.3 三步迭代本地更新、全局平均、对偶累积ADMM 的迭代分三步形式非常固定第一步每个节点在本地求解自己的子问题把全局变量 z 当前值当作已知量$$ \theta_i^{k1} \arg\min_{\theta} \left( f_i(\theta) \frac{\rho}{2} \lVert \theta - z^k u_i^k \rVert^2 \right) $$如果 f_i(\theta) 是二次型这一步有闭式解不需要调求解器。第二步把各节点的 \theta_i^{k1} 汇总取平均得到新的全局变量$$ z^{k1} \frac{1}{N} \sum_{i1}^{N} \left( \theta_i^{k1} u_i^k \right) $$这一步在工程实现里就是一次广播加一次求和取平均计算量可以忽略。第三步每个节点更新自己的对偶变量累积这次的本地副本与全局副本之差$$ u_i^{k1} u_i^k \theta_i^{k1} - z^{k1} $$可以把这个过程理解成大家先各自按自己的测量算一个位置然后看看全体的平均位置在哪里把自己往平均方向拉一点u_i 则是记录“我一直被拉了多少”的账本防止迭代过早停在某个节点的偏差上。3.4 通信协议与停止条件整套分布式定位的通信协议其实很简单每轮迭代只需要两个回合中心节点或者任意一个协调节点把 z^k 广播给所有节点每个节点算完 \theta_i 和 u_i 后把 s_i \theta_i u_i 回传给协调节点协调节点对所有 s_i 取平均得到 z^{k1}再广播。每轮每个节点上行一个三维或四维的浮点向量下行一个同样的向量和传原始 TDOA 测量相比通信量小了一个量级。停止条件用相邻两轮 z 的变化量或者原始残差和对偶残差同时小于阈值后者我放在最后一章细说。这里有一个工程细节容易忽略协调节点是谁。常见做法是选链路质量最好的那个节点担任或者直接用 Gossip 算法做全网异步平均去掉中心节点。后者更符合“真分布式”的定义但收敛分析会更复杂我一般先用有协调节点的版本验证算法再考虑 Gossip 化。3.5 为什么是 ADMM对比分布式次梯度的工程经验还有一条常见的分布式求解路线是分布式次梯度每个节点算完本地梯度后沿梯度方向走一步再做一次平均。从实现上看它更简单但坑在于步长太难选步长太大迭代震荡不收敛步长太小收敛慢到没法用而且步长的合理区间和 Lipschitz 常数、网络拓扑都有关玄学成分很大。ADMM 的工程优势在于惩罚参数 \rho 在一定范围内不敏感且不需要每轮调步长本地二次子问题又有闭式解。代价是每轮多了一个对偶变量要维护内存多存一个 3N 维的向量这在实际部署中几乎可以忽略。所以做这类分布式定位我的默认起点就是 ADMM。4. 最小可复现算例MATLAB 里跑通分布式 TDOA 定位原理讲再多不如一个能跑的算例。这一章给出一个最小但完整的 MATLAB 实现四个锚点、一个目标、TDOA 测量ADMM 分布式求解。代码量控制在 60 行以内跑完能看到位置误差和收敛曲线。4.1 场景与观测生成先造一个 2D 平面场景四个锚点坐标目标真实位置取 (2, 3)单位米。TDOA 以 1 号锚点为参考给测量加上标准差 0.05 米的高斯噪声% 锚点坐标每行是一个站的 (x, y) s [0 0; 12 0; 5 10; -6 8]; % 目标真实位置 xt [2; 3]; % 计算各锚点到目标的真实距离 dist_true zeros(4, 1); for i 1:4 dist_true(i) norm(xt. - s(i, :)); end % TDOA 测量2~4 号站相对于 1 号站的距离差加高斯噪声 sigma 0.05; tau dist_true(2:4) - dist_true(1) sigma * randn(3, 1);这里 tau 是 3×1 的向量对应锚点 2、3、4 相对锚点 1 的到达时间差。注意噪声加在距离差上单位是米不是秒如果拿到的是时间差要乘以信号传播速度转换成距离差。4.2 ADMM 主循环下面这段代码在单个 MATLAB 进程里模拟四个节点的分布式计算主循环就是第 3 章的三个步骤% ADMM 参数 rho 1; % 惩罚参数 maxIter 200; % 最大迭代次数 tol 1e-6; % 停止阈值 lambda 1e-6; % 参考站的正则系数 N 4; % 节点数 theta zeros(N, 3);% 每个节点的本地变量 [x; y; r1] u zeros(N, 3); % 对偶变量 z zeros(3, 1); % 全局一致变量 for k 1:maxIter % 第一步每个节点本地更新 for i 1:N if i 1 % 参考站没有有效 TDOA 方程加极小正则项 H rho * eye(3); rhs rho * (z - u(i, :).); theta(i, :) (H \ rhs).; else % 构造本地线性观测方程 A_i * theta b_i di s(i, :) - s(1, :); Ai [2 * di, 2 * tau(i - 1)]; bi norm(s(i, :))^2 - norm(s(1, :))^2 - tau(i - 1)^2; H Ai. * Ai rho * eye(3); rhs Ai. * bi rho * (z - u(i, :).); theta(i, :) (H \ rhs).; end end % 第二步全局平均得到新的 z z_new mean(theta u, 1).; % 停止条件相邻两轮 z 的变化足够小 if norm(z_new - z) tol z z_new; break; end z z_new; % 第三步对偶变量更新 u u theta - repmat(z., N, 1); end % 定位结果theta 的前两维是位置 x_hat z(1:2); pos_err norm(x_hat - xt); fprintf(估计位置: (%.3f, %.3f) m, 位置误差: %.3f m\n, ... x_hat(1), x_hat(2), pos_err);这段代码里 H 和 rhs 的构造是核心逻辑。对非参考节点Ai 是由锚点坐标差和 TDOA 测量值拼出来的 1×3 向量bi 是常数项H Ai. * Ai rho * eye(3) 就是本地二次子问题的 Hessianrho 保证了即使某个节点的 Ai. * Ai 秩亏损H 也可逆。参考站那条分支需要解释一下。原始 TDOA 测量里参考站的距离被消掉了它本身没有一条像其他节点那样的方程但分布式平均又需要它参与。常见做法是给它一个很小的正则项让它的本地估计基本跟随全局 z而不是独立往某个方向拉整个网络。4.3 参数说明与调参要点参数默认值作用说明rho1一致性惩罚强度影响收敛速度与噪声敏感度maxIter200最大迭代次数实网建议 500tol1e-6z 变化量阈值太小会白跑多轮sigma0.05观测噪声标准差仿真时用来测鲁棒性lambda1e-6参考站正则系数只要不造成数值问题就不动rho 是这套迭代里唯一值得认真调的参数。取 1 在大多数场景都能正常收敛取 0.1 会让收敛变慢但位置估计更平滑取 10 会加速收敛但噪声更容易通过 z 的平均直接进入位置估计。具体的翻车案例在第 5 章展开。4.4 验证位置误差、收敛曲线与蒙特卡洛跑一次只能说明代码没写错不能说明算法可用。我一般做三件事第一打印位置误差噪底 0.05 米时误差在 0.1~0.2 米量级算正常。第二画收敛曲线看相邻两轮 z 的范数变化应该是单调下降然后在某个值附近波动。第三把上面的场景重复跑 200 次蒙特卡洛统计位置误差的均方根值和 90% 分位点。只看单次结果很容易被某次幸运的噪声误导尤其是分布式算法涉及随机初始化的情况。蒙特卡洛的改法很简单外面套一层 for 循环每次重新生成 tau记录 x_hat 误差最后算 RMSE。如果 RMSE 明显大于 3 倍 sigma先检查代码里是否把 tau 当成了绝对距离而不是距离差这个错误我见过不止一次。4.5 扩展到 3D、多锚点与真实时延测量把这个最小算例推广到 3D改动量很小theta 从三维变成四维 [x; y; z; r1]Ai 从 1×3 变成 1×4代码里所有 eye(3) 改成 eye(4)锚点坐标从两列变成三列即可。锚点变多的情况更值得注意。每个节点可以有多条 TDOA 方程不一定只有一个锚点Ai 变成多行矩阵bi 变成列向量本地更新公式完全不用变H 的尺寸跟着 Ai 走就行。真实工程里往往是“一个节点收到多个邻站的 TDOA”所以这个扩展才是常态。真实时延测量还有两个额外的预处理要做一是对两路信号做互相关或广义互相关估计时延不能直接把无线帧里的时间戳相减二是要先把站间时钟偏差标定掉否则分布式算法算得再好输入就是偏的。5. 分布式定位避坑笔记松弛不紧、参数玄学与节点翻车这章写我在这条技术路线上踩过的坑。每条都按“现象、原因、解决”来写希望能让你少走弯路。5.1 松弛不紧SDP 解出的秩一条件不满足现象SDR 求解完成检查 Y 的特征值最大特征值和第二特征值在同一个数量级定位结果在真实位置附近来回漂有时候甚至跑到锚点围成的凸包外。原因半定松弛只有在噪声足够小、锚点几何足够好的时候才保证紧性。高噪声或者锚点近似共线时松弛后的凸可行域比原始非凸问题大得多最优解落在非秩一区域这时 \theta 的前两维不再是可信位置估计。解决先算 GDOP锚点共线直接放弃 SDR 改用更多锚点噪声大时对 TDOA 方程按测量方差加权比用均匀权更不容易松弛失效如果是在线场景可以拿 SOCR 结果做初值跑几步 Gauss-Newton 精化而不是硬用松弛解。5.2 惩罚参数 rho 的玄学调大收敛快噪声也放大现象rho 从 1 调到 10迭代次数确实从一百多轮降到三四十轮但最终位置误差反而大了一倍。原因ADMM 的一致性约束通过 rho 把每个节点的本地估计强行拉向全局平均。rho 越大z 对单个节点本地噪声越敏感换句话说一个测量质量很差的节点会通过全局平均把误差注入所有人的估计。解决不要只看收敛速度调 rho。我现在的习惯是固定 rho1 先把算法跑通再观察原始残差和对偶残差的比值如果对偶残差远大于原始残差调小 rho反过来调大 rho。这属于工程调参的“玄学”但比拍脑袋选数可靠得多。5.3 节点掉线与通信丢包同步 ADMM 直接翻车现象仿真里一切正常实网里某个节点掉线或者某几轮 z 广播丢失之后全局平均直接偏掉位置估计漂出几百米。原因同步 ADMM 假设每轮每个节点都参与平均。一旦某个节点缺失均值计算就少了一项更严重的是掉线节点的对偶变量 u_i 停在上一个状态等它恢复后会给全局引入一个过期的偏差。解决轻量方案是在协调节点维护掉线节点的最近一次 s_i 值参与平均等它恢复后再计入真实值正规方案是改成异步 ADMM让每个节点按自己的节奏更新协调节点只对收到的子集做加权平均。工程上我建议优先做掉线检测和状态标记而不是一上来就上异步算法否则收敛性很难验证。5.4 锚点共线与参考锚点选错矩阵病态与全局漂移现象四个锚点基本排成一条直线A_i 矩阵条件数上万迭代倒是能跑完但位置误差在几十米量级。原因锚点共线时 TDOA 双曲线的交点退化定位问题本身的几何条件数就很差不管凸松弛还是 ADMM 都救不回来参考锚点选在边缘站时所有距离差都对应很小的基线测量噪声被几何因子放大。解决参考锚点选几何中心附近的站选测量方差小的站锚点布局上尽量让围成的面积最大可以用 GDOP 作为布局优化目标。这个坑不是算法问题是数据问题算法无法弥补几何信息缺失。5.5 拿松弛解当定位结果缺最后一步精化现象SOCR 解出来的位置有明显偏差但迭代已经收敛怎么调参数都降不下去。原因二阶锥松弛用的是 t_i 上界变量松弛后的最优解不满足原始距离差方程它给的只是一个“可行凸域里的最优”不是“原始非凸问题的最优”。解决把 SOCR 解作为初值对原始加权最小二乘做几步 Gauss-Newton 精化通常两到三次迭代就能把误差降到接近理论 CRB。很多论文只写松弛不提精化但工程落地时这一步几乎是必须的否则精度根本无法满足定位要求。6. 进阶在线分布式定位、事件触发通信与收敛性验证扫码式一口气讲了基本做法最后给三个我实际工程中常用的进阶处理。6.1 事件触发通信只让“欠收敛”的节点发消息前面提到每轮每个节点都要上行一次 θ_i u_i这在节点数几十上百时依然是负担。常见优化是事件触发通信每个节点本地维护上一次发送的 s_i_old只有当 \lVert s_i^k - s_i_old \rVert 超过阈值时才发送否则协调节点沿用旧值参与平均。这个改动可以让通信量降一到两个量级而且对收敛精度影响很小。阈值我一般取 0.01 米对应的时间差量级具体要根据测量噪声 std 来定太大会让 z 过早停滞。6.2 两个残差判收敛别只看位置误差最后收敛判定不要只看 \lVert z^k - z^{k-1} \rVert更可靠的是同时看原始残差和对偶残差$$ r_{prim} \lVert \theta^k - z^k \rVert_\infty, \quad r_{dual} \rho \lVert z^k - z^{k-1} \rVert_\infty $$两者都低于阈值才判收敛。只看位置误差的坏处是某个场景下误差恰好很小但算法其实没收敛换一个噪声样本就翻车。我前几次仿真就是只盯 RMSE结果换场景就出问题血泪经验。现在习惯把这两条残差曲线和位置误差画在同一张图上RMSE 收敛和残差收敛对上才敢说这套分布式定位代码真正落地了。希望帮到你。本文还有配套的精品资源点击获取 
长河君 · 2026/10/7 22:06:15 · 阅读 1.2k 凸优化与分布式目标定位：从TDOA建模范式到ADMM工程实践
简介这是一份关于基于凸优化的分布式目标定位技术研究的学术pdf文档适合无线传感器网络、信号处理及分布式优化方向的研究生、科研人员作为参考文献。资料从凸优化理论基础切入系统论述标准形式、最优解条件及拉格朗日对偶机制并重点讲解分布式ADMM算法如何将非凸最小二乘目标函数松弛为凸问题通过变量分解与迭代求解完成目标定位同时给出深海目标定位等应用场景的过程与算法步骤。此外还讨论了收敛速度、鲁棒性及低功耗策略等未来研究方向。压缩包内共1个PDF文件大小约96KB内容较完整地保留了摘要、关键词、公式推导与参考文献。文档已有143人浏览学习适合快速获取该研究脉络用于论文调研、课堂报告或课题起步参考。1. 凸优化与分布式目标定位这套组合到底解决谁的痛点早些年做多基站无源定位我最怕的不是测量噪声而是把最大似然目标函数扔进求解器之后十次初值有九次收敛到局部极小。问题本质在于定位方程里带两个范数相减目标函数天然非凸而当我们把节点从四个扩到二十个、从集中式处理换成分布式架构时连“把所有测量传到中心节点再算一次全局最优”这条路也走不通了。凸优化与分布式目标定位就是把这两件事一起解决先用半定松弛或二阶锥松弛把非凸定位改写成一个可全局求解的凸问题再用分布式 ADMM 把计算拆到每个节点上节点之间只交换低维中间变量最终收敛到和集中式基本一致的结果。适合做无线传感器网络定位、无人集群协同定位、多基地探测这类场景的工程师尤其是手里有实网数据、被集中式算力和通信瓶颈卡过的人。2. 从非凸到凸TDOA 建模、半定松弛与二阶锥松弛选型目标定位的观测量一般分四类TOA到达时间、TDOA到达时间差、RSS接收信号强度、AOA到达角度。工程里 TDOA 用得最多因为只要各接收站时间同步它天然消掉了目标发射时刻这个未知量不需要目标端配合。这章先把 TDOA 定位为什么非凸讲清楚再给出两条把它改写成凸问题的常见路线半定松弛和二阶锥松弛。2.1 TDOA 观测模型为什么最大似然是非凸的假设平面内有 N 个锚点基站坐标 s_i 已知目标真实位置 x 未知。以 1 号站为参考站对第 i 个站测量到达时间差折算成距离差$$ r_{i1} \lVert x - s_i \rVert - \lVert x - s_1 \rVert e_{i1} $$如果噪声服从高斯分布最大似然估计等价于加权最小二乘$$ \min_{x} \sum_{i2}^{N} w_i \left( \lVert x - s_i \rVert - \lVert x - s_1 \rVert - r_{i1} \right)^2 $$这里的问题一眼就能看出来两个欧几里得范数相减函数关于 x 是非凸的而且在所有锚点连线的延长线附近存在不可导点。直接上梯度下降、高斯牛顿或者 fmincon结果强烈依赖初值初值给到双曲线的错误支上迭代就跑到几何上完全错误的位置。更麻烦的是目标函数会有多个局部极小其中很多局部极小对应的残差并不大靠“多初值试一遍”在实时场景里根本不可接受。所以这条技术路线的基本逻辑是非凸问题不能硬解要找它的凸近似保证无论初值在哪求解器拿到的是同一个全局最优。2.2 半定松弛把二次等式扔掉换一个凸可行域TDOA 方程有一个经典的代数变形。设参考距离 r_1 \lVert x - s_1 \rVert把原始距离差等式两边同时加 r_1 再平方可以消掉根号得到关于未知向量 \theta [x; r_1] 的线性方程$$ 2(s_i - s_1)^\top x 2r_{i1} r_1 \lVert s_i \rVert^2 - \lVert s_1 \rVert^2 - r_{i1}^2 $$写成紧凑形式就是 A_i \theta b_i其中 A_i 是 1×3 的矩阵b_i 是标量。到这一步还是不够因为 \theta 内部有一个隐藏约束r_1 必须等于 \lVert x - s_1 \rVert也就是 \theta^\top C \theta c^\top \theta 0这是一个二次等式依然非凸。半定松弛的做法很直接令 Y \theta\theta^\top把二次约束变成关于 Y 和 \theta 的线性表达式然后用凸的半定约束 Y \succeq \theta\theta^\top等价于分块矩阵 [Y, \theta; \theta^\top, 1] 半正定去替代严格相等的秩一约束。丢掉“Y 的秩必须为 1”这个非凸条件之后问题就变成一个标准的半定规划$$ \min_{Y,\theta} \sum_{i2}^{N} w_i (A_i\theta - b_i)^2 \quad \text{s.t.} \quad \begin{bmatrix} Y \theta \ \theta^\top 1 \end{bmatrix} \succeq 0 $$解完之后检查 Y 的特征值如果最大特征值远大于第二特征值说明松弛是紧的\theta 的前两维就是目标位置如果秩一条件被打破定位结果会明显恶化。后面第 5 章专门讲这种情况的坑。2.3 二阶锥松弛实时定位场景的轻量替代半定松弛在锚点数少、噪声水平适中的时候精度很好但 SDP 的求解代价偏高尤其是节点数量上来之后求解器一轮内点迭代的矩阵分解开销会让人劝退。另一个常见替代是用二阶锥松弛。思路是把每个距离 \lVert x - s_i \rVert 替换成它的上界变量 t_i用 t_i - t_1 来拟合 TDOA 测量值约束写成$$ \lVert x - s_i \rVert \le t_i, \quad i 1,\dots,N $$这样目标函数变成 sum_i w_i (t_i - t_1 - r_{i1})^2可行域是凸的二阶锥求解速度比 SDP 快一个量级。代价是松弛后的解通常不在原始双曲线的交点上精度在低噪声场景下比 SDR 略差但实时性要求高的系统基本都选这条路。2.4 选型对照锚点数、噪声与算力怎么权衡维度半定松弛 SDR二阶锥松弛 SOCR建模难度需要引入 Y 和 PSD 约束推导稍重只需要引入 t_i 变量和范数锥求解速度慢节点多时内点迭代吃力快适合实时和嵌入式噪声鲁棒性高松弛更容易保持紧性中等高噪声下误差偏大锚点布局敏感锚点共线时仍会失效锚点共线时更明显典型场景离线标定、后处理、高精度定位在线定位、资源受限节点我自己的选型习惯是如果目标是做采集后的高精度分析、锚点数量不多优先试 SDR如果是无人集群实时协同定位直接上 SOCR ADMM精度不够再用 SDR 做参考解离线评估。工程上“先跑通、再提精度”比“一上来就追求理论上界”重要得多。3. 分布式求解架构用 ADMM 把定位拆到节点上就算把非凸定位松弛成凸问题集中式求解在真实分布式系统里依然不现实。这章讲清楚为什么要分布式以及 ADMM 怎么把全局凸问题拆成各个节点只用自己的测量、只跟邻居交换低维变量的迭代过程。3.1 集中式求解的三个卡点通信、算力、故障集中式定位的工作方式是每个节点把原始测量值时延差值、坐标、质量因子全部发到中心节点中心节点组装一个全局优化问题求解完再把目标位置广播回去。三个卡点都很现实。第一是通信负载。发的是带时间戳的原始测量不是中间变量随着锚点数量增长中心节点上行带宽很快就成为瓶颈。第二是算力。SDP 的变量维度在 2D 场景下就有 9 个Y 是 3×3 的对称阵锚点再多、还要做加权和去 NLOS 预处理时单节点算力扛不住。第三是单点故障。中心节点一掉全网定位直接全停。分布式架构的意义不是“看起来更高级”而是把通信量从原始测量降到低维中间变量把算力分摊到每个节点并且去掉中心依赖。3.2 问题分解一致性约束与增广拉格朗日上一章的凸松弛最终都能写成如下形式$$ \min_{\theta} \sum_{i1}^{N} f_i(\theta) $$其中 f_i(\theta) 是第 i 个节点基于本地锚点坐标和本地 TDOA 测量构造出来的代价函数\theta 是全局目标变量2D 定位时是 [x; r_1]三维向量3D 定位时是四维向量。每个节点都想算同一个 \theta但各自只掌握一部分数据。分布式 ADMM 的标准做法是给每个节点引入一个本地副本 \theta_i再通过一致性约束强制所有副本相等$$ \min_{\theta_i} \sum_{i1}^{N} f_i(\theta_i) \quad \text{s.t.} \quad \theta_i z, \ i 1,\dots,N $$这里 z 是全局的一致变量。写成增广拉格朗日形式就是每条约束后面挂一个对偶变量 u_i再给一致性偏差加一个二次惩罚项。这个二次惩罚项就是 ADMM 能收敛的关键它让每个节点在本地算自己的 \theta_i 时始终被“拉向”当前的全局 z。3.3 三步迭代本地更新、全局平均、对偶累积ADMM 的迭代分三步形式非常固定第一步每个节点在本地求解自己的子问题把全局变量 z 当前值当作已知量$$ \theta_i^{k1} \arg\min_{\theta} \left( f_i(\theta) \frac{\rho}{2} \lVert \theta - z^k u_i^k \rVert^2 \right) $$如果 f_i(\theta) 是二次型这一步有闭式解不需要调求解器。第二步把各节点的 \theta_i^{k1} 汇总取平均得到新的全局变量$$ z^{k1} \frac{1}{N} \sum_{i1}^{N} \left( \theta_i^{k1} u_i^k \right) $$这一步在工程实现里就是一次广播加一次求和取平均计算量可以忽略。第三步每个节点更新自己的对偶变量累积这次的本地副本与全局副本之差$$ u_i^{k1} u_i^k \theta_i^{k1} - z^{k1} $$可以把这个过程理解成大家先各自按自己的测量算一个位置然后看看全体的平均位置在哪里把自己往平均方向拉一点u_i 则是记录“我一直被拉了多少”的账本防止迭代过早停在某个节点的偏差上。3.4 通信协议与停止条件整套分布式定位的通信协议其实很简单每轮迭代只需要两个回合中心节点或者任意一个协调节点把 z^k 广播给所有节点每个节点算完 \theta_i 和 u_i 后把 s_i \theta_i u_i 回传给协调节点协调节点对所有 s_i 取平均得到 z^{k1}再广播。每轮每个节点上行一个三维或四维的浮点向量下行一个同样的向量和传原始 TDOA 测量相比通信量小了一个量级。停止条件用相邻两轮 z 的变化量或者原始残差和对偶残差同时小于阈值后者我放在最后一章细说。这里有一个工程细节容易忽略协调节点是谁。常见做法是选链路质量最好的那个节点担任或者直接用 Gossip 算法做全网异步平均去掉中心节点。后者更符合“真分布式”的定义但收敛分析会更复杂我一般先用有协调节点的版本验证算法再考虑 Gossip 化。3.5 为什么是 ADMM对比分布式次梯度的工程经验还有一条常见的分布式求解路线是分布式次梯度每个节点算完本地梯度后沿梯度方向走一步再做一次平均。从实现上看它更简单但坑在于步长太难选步长太大迭代震荡不收敛步长太小收敛慢到没法用而且步长的合理区间和 Lipschitz 常数、网络拓扑都有关玄学成分很大。ADMM 的工程优势在于惩罚参数 \rho 在一定范围内不敏感且不需要每轮调步长本地二次子问题又有闭式解。代价是每轮多了一个对偶变量要维护内存多存一个 3N 维的向量这在实际部署中几乎可以忽略。所以做这类分布式定位我的默认起点就是 ADMM。4. 最小可复现算例MATLAB 里跑通分布式 TDOA 定位原理讲再多不如一个能跑的算例。这一章给出一个最小但完整的 MATLAB 实现四个锚点、一个目标、TDOA 测量ADMM 分布式求解。代码量控制在 60 行以内跑完能看到位置误差和收敛曲线。4.1 场景与观测生成先造一个 2D 平面场景四个锚点坐标目标真实位置取 (2, 3)单位米。TDOA 以 1 号锚点为参考给测量加上标准差 0.05 米的高斯噪声% 锚点坐标每行是一个站的 (x, y) s [0 0; 12 0; 5 10; -6 8]; % 目标真实位置 xt [2; 3]; % 计算各锚点到目标的真实距离 dist_true zeros(4, 1); for i 1:4 dist_true(i) norm(xt. - s(i, :)); end % TDOA 测量2~4 号站相对于 1 号站的距离差加高斯噪声 sigma 0.05; tau dist_true(2:4) - dist_true(1) sigma * randn(3, 1);这里 tau 是 3×1 的向量对应锚点 2、3、4 相对锚点 1 的到达时间差。注意噪声加在距离差上单位是米不是秒如果拿到的是时间差要乘以信号传播速度转换成距离差。4.2 ADMM 主循环下面这段代码在单个 MATLAB 进程里模拟四个节点的分布式计算主循环就是第 3 章的三个步骤% ADMM 参数 rho 1; % 惩罚参数 maxIter 200; % 最大迭代次数 tol 1e-6; % 停止阈值 lambda 1e-6; % 参考站的正则系数 N 4; % 节点数 theta zeros(N, 3);% 每个节点的本地变量 [x; y; r1] u zeros(N, 3); % 对偶变量 z zeros(3, 1); % 全局一致变量 for k 1:maxIter % 第一步每个节点本地更新 for i 1:N if i 1 % 参考站没有有效 TDOA 方程加极小正则项 H rho * eye(3); rhs rho * (z - u(i, :).); theta(i, :) (H \ rhs).; else % 构造本地线性观测方程 A_i * theta b_i di s(i, :) - s(1, :); Ai [2 * di, 2 * tau(i - 1)]; bi norm(s(i, :))^2 - norm(s(1, :))^2 - tau(i - 1)^2; H Ai. * Ai rho * eye(3); rhs Ai. * bi rho * (z - u(i, :).); theta(i, :) (H \ rhs).; end end % 第二步全局平均得到新的 z z_new mean(theta u, 1).; % 停止条件相邻两轮 z 的变化足够小 if norm(z_new - z) tol z z_new; break; end z z_new; % 第三步对偶变量更新 u u theta - repmat(z., N, 1); end % 定位结果theta 的前两维是位置 x_hat z(1:2); pos_err norm(x_hat - xt); fprintf(估计位置: (%.3f, %.3f) m, 位置误差: %.3f m\n, ... x_hat(1), x_hat(2), pos_err);这段代码里 H 和 rhs 的构造是核心逻辑。对非参考节点Ai 是由锚点坐标差和 TDOA 测量值拼出来的 1×3 向量bi 是常数项H Ai. * Ai rho * eye(3) 就是本地二次子问题的 Hessianrho 保证了即使某个节点的 Ai. * Ai 秩亏损H 也可逆。参考站那条分支需要解释一下。原始 TDOA 测量里参考站的距离被消掉了它本身没有一条像其他节点那样的方程但分布式平均又需要它参与。常见做法是给它一个很小的正则项让它的本地估计基本跟随全局 z而不是独立往某个方向拉整个网络。4.3 参数说明与调参要点参数默认值作用说明rho1一致性惩罚强度影响收敛速度与噪声敏感度maxIter200最大迭代次数实网建议 500tol1e-6z 变化量阈值太小会白跑多轮sigma0.05观测噪声标准差仿真时用来测鲁棒性lambda1e-6参考站正则系数只要不造成数值问题就不动rho 是这套迭代里唯一值得认真调的参数。取 1 在大多数场景都能正常收敛取 0.1 会让收敛变慢但位置估计更平滑取 10 会加速收敛但噪声更容易通过 z 的平均直接进入位置估计。具体的翻车案例在第 5 章展开。4.4 验证位置误差、收敛曲线与蒙特卡洛跑一次只能说明代码没写错不能说明算法可用。我一般做三件事第一打印位置误差噪底 0.05 米时误差在 0.1~0.2 米量级算正常。第二画收敛曲线看相邻两轮 z 的范数变化应该是单调下降然后在某个值附近波动。第三把上面的场景重复跑 200 次蒙特卡洛统计位置误差的均方根值和 90% 分位点。只看单次结果很容易被某次幸运的噪声误导尤其是分布式算法涉及随机初始化的情况。蒙特卡洛的改法很简单外面套一层 for 循环每次重新生成 tau记录 x_hat 误差最后算 RMSE。如果 RMSE 明显大于 3 倍 sigma先检查代码里是否把 tau 当成了绝对距离而不是距离差这个错误我见过不止一次。4.5 扩展到 3D、多锚点与真实时延测量把这个最小算例推广到 3D改动量很小theta 从三维变成四维 [x; y; z; r1]Ai 从 1×3 变成 1×4代码里所有 eye(3) 改成 eye(4)锚点坐标从两列变成三列即可。锚点变多的情况更值得注意。每个节点可以有多条 TDOA 方程不一定只有一个锚点Ai 变成多行矩阵bi 变成列向量本地更新公式完全不用变H 的尺寸跟着 Ai 走就行。真实工程里往往是“一个节点收到多个邻站的 TDOA”所以这个扩展才是常态。真实时延测量还有两个额外的预处理要做一是对两路信号做互相关或广义互相关估计时延不能直接把无线帧里的时间戳相减二是要先把站间时钟偏差标定掉否则分布式算法算得再好输入就是偏的。5. 分布式定位避坑笔记松弛不紧、参数玄学与节点翻车这章写我在这条技术路线上踩过的坑。每条都按“现象、原因、解决”来写希望能让你少走弯路。5.1 松弛不紧SDP 解出的秩一条件不满足现象SDR 求解完成检查 Y 的特征值最大特征值和第二特征值在同一个数量级定位结果在真实位置附近来回漂有时候甚至跑到锚点围成的凸包外。原因半定松弛只有在噪声足够小、锚点几何足够好的时候才保证紧性。高噪声或者锚点近似共线时松弛后的凸可行域比原始非凸问题大得多最优解落在非秩一区域这时 \theta 的前两维不再是可信位置估计。解决先算 GDOP锚点共线直接放弃 SDR 改用更多锚点噪声大时对 TDOA 方程按测量方差加权比用均匀权更不容易松弛失效如果是在线场景可以拿 SOCR 结果做初值跑几步 Gauss-Newton 精化而不是硬用松弛解。5.2 惩罚参数 rho 的玄学调大收敛快噪声也放大现象rho 从 1 调到 10迭代次数确实从一百多轮降到三四十轮但最终位置误差反而大了一倍。原因ADMM 的一致性约束通过 rho 把每个节点的本地估计强行拉向全局平均。rho 越大z 对单个节点本地噪声越敏感换句话说一个测量质量很差的节点会通过全局平均把误差注入所有人的估计。解决不要只看收敛速度调 rho。我现在的习惯是固定 rho1 先把算法跑通再观察原始残差和对偶残差的比值如果对偶残差远大于原始残差调小 rho反过来调大 rho。这属于工程调参的“玄学”但比拍脑袋选数可靠得多。5.3 节点掉线与通信丢包同步 ADMM 直接翻车现象仿真里一切正常实网里某个节点掉线或者某几轮 z 广播丢失之后全局平均直接偏掉位置估计漂出几百米。原因同步 ADMM 假设每轮每个节点都参与平均。一旦某个节点缺失均值计算就少了一项更严重的是掉线节点的对偶变量 u_i 停在上一个状态等它恢复后会给全局引入一个过期的偏差。解决轻量方案是在协调节点维护掉线节点的最近一次 s_i 值参与平均等它恢复后再计入真实值正规方案是改成异步 ADMM让每个节点按自己的节奏更新协调节点只对收到的子集做加权平均。工程上我建议优先做掉线检测和状态标记而不是一上来就上异步算法否则收敛性很难验证。5.4 锚点共线与参考锚点选错矩阵病态与全局漂移现象四个锚点基本排成一条直线A_i 矩阵条件数上万迭代倒是能跑完但位置误差在几十米量级。原因锚点共线时 TDOA 双曲线的交点退化定位问题本身的几何条件数就很差不管凸松弛还是 ADMM 都救不回来参考锚点选在边缘站时所有距离差都对应很小的基线测量噪声被几何因子放大。解决参考锚点选几何中心附近的站选测量方差小的站锚点布局上尽量让围成的面积最大可以用 GDOP 作为布局优化目标。这个坑不是算法问题是数据问题算法无法弥补几何信息缺失。5.5 拿松弛解当定位结果缺最后一步精化现象SOCR 解出来的位置有明显偏差但迭代已经收敛怎么调参数都降不下去。原因二阶锥松弛用的是 t_i 上界变量松弛后的最优解不满足原始距离差方程它给的只是一个“可行凸域里的最优”不是“原始非凸问题的最优”。解决把 SOCR 解作为初值对原始加权最小二乘做几步 Gauss-Newton 精化通常两到三次迭代就能把误差降到接近理论 CRB。很多论文只写松弛不提精化但工程落地时这一步几乎是必须的否则精度根本无法满足定位要求。6. 进阶在线分布式定位、事件触发通信与收敛性验证扫码式一口气讲了基本做法最后给三个我实际工程中常用的进阶处理。6.1 事件触发通信只让“欠收敛”的节点发消息前面提到每轮每个节点都要上行一次 θ_i u_i这在节点数几十上百时依然是负担。常见优化是事件触发通信每个节点本地维护上一次发送的 s_i_old只有当 \lVert s_i^k - s_i_old \rVert 超过阈值时才发送否则协调节点沿用旧值参与平均。这个改动可以让通信量降一到两个量级而且对收敛精度影响很小。阈值我一般取 0.01 米对应的时间差量级具体要根据测量噪声 std 来定太大会让 z 过早停滞。6.2 两个残差判收敛别只看位置误差最后收敛判定不要只看 \lVert z^k - z^{k-1} \rVert更可靠的是同时看原始残差和对偶残差$$ r_{prim} \lVert \theta^k - z^k \rVert_\infty, \quad r_{dual} \rho \lVert z^k - z^{k-1} \rVert_\infty $$两者都低于阈值才判收敛。只看位置误差的坏处是某个场景下误差恰好很小但算法其实没收敛换一个噪声样本就翻车。我前几次仿真就是只盯 RMSE结果换场景就出问题血泪经验。现在习惯把这两条残差曲线和位置误差画在同一张图上RMSE 收敛和残差收敛对上才敢说这套分布式定位代码真正落地了。希望帮到你。本文还有配套的精品资源点击获取