简介基于正则化约束总体最小二乘RCTLS的单站DOA-TDOA无源定位算法复现文档面向无线通信、雷达、导航定位领域的科研人员与工程师旨在解决单站联合利用到达角度DOA与到达时差TDOA进行定位时面临的方程病态和精度不足问题。资源为单个docx文档压缩包共1个文件大小仅53KB但内容涵盖完整可运行Python代码及逐步解释包括RCTLS_DOATDOA类初始化、观测方程线性化、代价函数构建、牛顿迭代求解器、最优正则化参数自动选择以及几何精度因子GDOP计算等模块。文档还深入讨论了系数矩阵病态问题的理论分析与改进实现给出低高度目标定位、误差建模、鲁棒求解器优化等扩展方向并通过仿真实验验证RCTLS相比传统CTLS在定位精度和鲁棒性上的优越性同时分析了目标与辐射源位置对定位精度的影响。已有73人学习浏览适合需要理论推导与工程实现并重或希望将改进算法用于单站无源定位系统及外辐射源布局优化的开发者参考。1. 单站 DOA-TDOA 无源定位为什么需要 RCTLS做单站无源定位的同行应该都有这种体会测向方程和时差方程各自都能列出来但联立之后解出来的目标点总是不对劲尤其是目标落在反射路径和直达路径夹角很小的区域时误差能到几百米。问题不在测向仪或时差检测器上而在求解方式上——你用的最小二乘默认系数矩阵是精确的可这个场景里 DOA 测量误差已经顺着三角函数爬进了系数矩阵。RCTLS正则化约束总体最小二乘就是为这种情况设计的它同时承认系数矩阵和观测向量都带噪声再用正则化项压制病态方程的解发散。这篇文章按论文复现的思路从公式推导讲到 MATLAB 实现再到参数调整和验证方法适合正在复现定位类论文、或者被测向测时差数据折磨的工程师照着落地。2. RCTLS 的理论拆解为什么 LS 会在 DOA-TDOA 上失效2.1 把 DOA 和 TDOA 写成 Axb方向线与路径差的两个线性化单站 DOA-TDOA 定位的模型假设是一个观测站接收目标信号除了直达径之外还有来自反射体的多径信号。观测站测到两个量——目标信号的到达方位角以及直达径与反射径之间的到达时间差。观测站位置、反射点位置已知目标坐标是待求量。先看 DOA。设观测站坐标为 $x_s[x_{s},y_{s}]^T$目标位置为 $p[p_x,p_y]^T$方位角 $\alpha$ 定义为从 x 轴逆时针转到目标方向的角度。目标在方向线上等价于目标相对观测站的矢量与方向单位矢量 $u[\cos\alpha,\sin\alpha]^T$ 平行也就是法向分量等于零。取 $u_\perp[-\sin\alpha,\cos\alpha]^T$DOA 方程就是$u_\perp^T(p-x_s)0$展开后得到一个关于 p 的线性方程$-\sin\alpha\cdot p_x\cos\alpha\cdot p_y-\sin\alpha\cdot x_s\cos\alpha\cdot y_s$这一行里 $\alpha$ 是测量值所以系数 $-\sin\alpha$ 和 $\cos\alpha$ 都带测量噪声右边也是。系数矩阵带噪声这件事就是 TLS 和 RCTLS 登场的理由。TDOA 部分要绕一个弯。第 i 条反射路径对应的反射点记为 $x_{r,i}$测得的直达径与反射径时差为 $\tau_i$统一转成距离差 $r_ic\tau_i$。直达径长度等于观测站到目标的距离 $d|p-x_s|$于是反射径长度可以写成 $d-r_i$符号约定后面避坑章会专门讲。由几何关系反射径长度又等于 $|p-x_{r,i}|$而 $px_sd\cdot u$代入并消去 $d^2$ 项后得到$d\frac{r_i^2-|x_s-x_{r,i}|^2}{2\left(u^T(x_s-x_{r,i})r_i\right)}$这个式子的含义是每条 TDOA 路径都能独立给出一个目标到观测站的距离估计 $d_i$$d_i$ 的噪声同时来自 $\tau_i$ 的测量误差和由 $\alpha$ 引入的 $u$ 的误差。把它写成纵向约束$u^T(p-x_s)d_i$现在把 DOA 的横向约束和每条 TDOA 的纵向约束叠起来就得到一个超定线性系统 $Jpy$。例如一个 DOA 加两条反射路径时$J\begin{bmatrix}-sin\alpha cos\alpha \ cos\alpha sin\alpha \ cos\alpha sin\alpha\end{bmatrix}, \quad y\begin{bmatrix}u_\perp^T x_s \ u^T x_sd_1 \ u^T x_sd_2\end{bmatrix}$这个形式的好处是所有测量误差都集中体现在 $J$ 和 $y$ 上后面无论用 LS、TLS 还是 RCTLS输入都是同一对矩阵。2.2 TLS 和 LS 的分水岭系数矩阵噪声不能假装不存在最小二乘的隐含假设是系数矩阵精确、只有观测向量有噪声。求解 $Jpy$ 时LS 给出的是让 $|Jp-y|2^2$ 最小的解闭式解为 $p{LS}(J^TJ)^{-1}J^Ty$。问题是这个模型里 $J$ 的每一行都是拿带噪的 $\alpha$ 算出来的三角函数。DOA 误差 0.5 度时$\sin\alpha$ 的相对误差在 0.0087 量级看起来不大但当 $J$ 接近病态、条件数达到 $10^4$ 以上时这个误差会被放大到完全不可接受的程度。LS 的解在此情况下是有偏的而且偏差方向不固定跟目标相对观测站的方位相关。总体最小二乘把噪声假设往前推了一步系数矩阵和观测向量都有噪声。它的目标是找一个尽可能小的扰动 $[\Delta J,\Delta y]$使得扰动后的方程组 $(J\Delta J)py\Delta y$ 严格相容。这个目标可以等价写成瑞利商形式$\min_p \frac{|Jp-y|^2}{1|p|^2}$分母里的 $|p|^2$ 来自对 $\Delta J$ 的 Frobenius 范数最小化这不是人为加进去的而是 TLS 问题的数学结构。求这个最小值不需要迭代优化对增广矩阵 $[J,y]$ 做 SVD取最小奇异值对应的右奇异向量 $v$令 $p_{TLS}v(1:n)/v(n1)$ 即可。注意分母是 $v$ 的最后一个分量如果它接近零说明问题退化TLS 解会非常不稳定这一刻就开始需要正则化了。2.3 正则化项如何压制病态RCTLS 的目标函数与梯度TLS 解决了系数矩阵噪声的问题但在单站 DOA-TDOA 场景里还不够。反射点、观测站、目标三者之间的几何关系一旦接近退化$J$ 的条件数会急剧膨胀。比如目标恰好落在观测站与反射点的延长线附近时TDOA 方程和 DOA 方程几乎线性相关$J$ 的最小奇异值趋近于零TLS 解虽然理论上无偏但方差大得没有实用价值。正则化的思路是给解的范数加一个惩罚项压制病态带来的解漂移。RCTLS 的目标函数写为$F(p)\frac{|Jp-y|^2}{1|p|^2}\lambda|p|^2$这里 $\lambda$ 是正则化参数。$\lambda0$ 时退化为 TLS把分母去掉则退化为岭回归但那样就丢失了系数噪声校正能力。这个目标函数第一项修正系数矩阵噪声第二项控制解的范数两者缺一不可。从约束的角度看正则化项等价于给解空间加了一个先验约束——这也就是约束两个字在 RCTLS 里的含义。求解这个函数我采用解析梯度加回溯线搜索。设 $rJp-y$$Nr^Tr$$D1p^Tp$梯度为$\nabla F\frac{2J^TrD-2Np}{D^2}2\lambda p$这个函数不是凸的所以初值选择很关键第 4 章会专门讲初值策略。$\lambda$ 较大时正则项给目标函数增加了凸性局部极小点会变少但 $\lambda$ 太大会把解拉向原点变成有偏估计这个矛盾是所有正则化方法都要面对的。3. 用 MATLAB 复现 RCTLS 单站定位从场景生成到三种方法对比3.1 场景与测量生成先跑通单次定位再谈统计复现定位算法第一步不是写求解器而是把场景参数定下来。这里用一个典型的多径单站场景观测站在坐标原点两个反射点分别模拟建筑物墙体和地面反射目标放在大约 3 公里外。这个尺度下DOA 误差 0.5 度对应的横向误差约为 26 米TDOA 误差 5 纳秒对应的距离误差约为 1.5 米量级差异明显正好能看出加权处理的价值。% 场景与测量生成单站多径 DOA-TDOA xs [0; 0]; % 观测站位置 (m) xr1 [800; 300]; % 反射点 1墙面(m) xr2 [-400; 900]; % 反射点 2地面/建筑(m) p_true [3000; 2200]; % 目标真实位置 (m) c 3e8; % 光速 (m/s) % 真实方向角与真实时差 u_true (p_true - xs) / norm(p_true - xs); alpha_true atan2(u_true(2), u_true(1)); tau1_true (norm(p_true - xs) - norm(p_true - xr1)) / c; tau2_true (norm(p_true - xs) - norm(p_true - xr2)) / c; % 添加测量噪声 sigma_alpha 0.5 * pi / 180; % 测向标准差 0.5 度 sigma_tau 5e-9; % 时差标准差 5 ns alpha alpha_true sigma_alpha * randn; tau1 tau1_true sigma_tau * randn; tau2 tau2_true sigma_tau * randn; % 由带噪测量构造线性系统 J * p y u [cos(alpha); sin(alpha)]; r1 c * tau1; r2 c * tau2; s1 u * (xs - xr1); s2 u * (xs - xr2); L1 (xs - xr1) * (xs - xr1); L2 (xs - xr2) * (xs - xr2); % 每条路径独立估计目标到观测站的距离 d1 (r1^2 - L1) / (2 * (s1 r1)); d2 (r2^2 - L2) / (2 * (s2 r2)); J [-sin(alpha), cos(alpha); % DOA 横向约束 cos(alpha), sin(alpha); % TDOA 路径 1 纵向约束 cos(alpha), sin(alpha)]; % TDOA 路径 2 纵向约束 y [-sin(alpha)*xs(1) cos(alpha)*xs(2); cos(alpha)*xs(1) sin(alpha)*xs(2) d1; cos(alpha)*xs(1) sin(alpha)*xs(2) d2];这段代码里最需要注意的是 $d_i$ 的计算。$\tau_i$ 的符号定义是直达径到达时间减去反射径到达时间所以 $r_i$ 是正的分母 $s_ir_i$ 的正负取决于反射点相对观测站和目标的几何关系。单次定位如果跑到镜像位置先检查这个符号不必急着怀疑求解器。3.2 RCTLS 求解器解析梯度与回溯线搜索的实现RCTLS 求解器是整个复现的核心。我不用现成的 fminunc而是手写梯度下降加回溯线搜索这样每一步都在掌控之中也方便在论文里解释算法细节。function x rctls_solve(J, y, lambda, opts) % RCTLS 求解器迭代求解正则化总体最小二乘 % 目标函数: F(x) ||Jx-y||^2 / (1||x||^2) lambda * ||x||^2 % 输入 % J : m x n 带噪系数矩阵 % y : m x 1 带噪观测向量 % lambda : 正则化参数 % opts : 可选结构体max_iter / tol / verbose % 输出 % x : 定位结果 if nargin 4, opts struct(); end max_iter 200; tol 1e-10; if isfield(opts, max_iter), max_iter opts.max_iter; end if isfield(opts, tol), tol opts.tol; end % 初值使用岭回归解保证在病态下也有合理起点 [m, n] size(J); x (J*J lambda*eye(n)) \ (J*y); for iter 1:max_iter r J*x - y; N r*r; D 1 x*x; F_old N/D lambda * (x*x); % 解析梯度 grad (2*J*r*D - 2*N*x) / D^2 2*lambda*x; % 回溯线搜索保证充分下降 alpha 1.0; while alpha 1e-12 x_new x - alpha * grad; r_new J*x_new - y; F_new (r_new*r_new)/(1 x_new*x_new) lambda*(x_new*x_new); if F_new F_old - 1e-4 * alpha * (grad*grad) break; end alpha alpha * 0.5; end if norm(x_new - x, inf) tol x x_new; break; end x x_new; end end这个实现里有几个参数值得说。充分下降准则里的 $10^{-4}$ 是优化教材里的标准值太小会让线搜索退化成全步长太大则步长衰减过快。回溯线搜索的初始步长设为 1如果目标函数不够光滑单次梯度下降可能跳出合理区域这时线搜索会自动把步长减半。迭代终止条件用的是无穷范数小于 $10^{-10}$对坐标量级在千米的定位问题来说这个阈值已经远低于双精度浮点的有效位数了。初值选择用岭回归解而不是纯 LS 解是因为当 $J$ 条件数很差时$(J^TJ)^{-1}$ 本身就不稳定加一个小的 $\lambda I$ 至少保证矩阵可逆且解在合理范围内。3.3 与 LS / TLS 对比Monte Carlo 循环与误差统计单次定位说明不了问题RCTLS 的论文复现一定需要 Monte Carlo 统计。TLS 的 SVD 解法实现很简单可以直接作为对比基准function x tls_solve(J, y) % 总体最小二乘对增广矩阵做 SVD取最小奇异值右奇异向量 [~, ~, V] svd([J, y]); v V(:, end); if abs(v(end)) 1e-12 x J \ y; % 退化时退化为 LS else x v(1:end-1) / v(end); end end主程序里对三种方法跑同样的随机噪声统计 RMSE% Monte Carlo 对比 LS / TLS / RCTLS N 500; err_ls zeros(N,1); err_tls zeros(N,1); err_rctls zeros(N,1); lambda 1e-6 * norm(J, fro)^2; % 正则化参数经验量级第 4 章详述 for k 1:N alpha alpha_true sigma_alpha * randn; tau1 tau1_true sigma_tau * randn; tau2 tau2_true sigma_tau * randn; u [cos(alpha); sin(alpha)]; r1 c*tau1; r2 c*tau2; s1 u*(xs-xr1); s2 u*(xs-xr2); d1 (r1^2-L1)/(2*(s1r1)); d2 (r2^2-L2)/(2*(s2r2)); Jk [-sin(alpha), cos(alpha); cos(alpha), sin(alpha); cos(alpha), sin(alpha)]; yk [-sin(alpha)*xs(1)cos(alpha)*xs(2); cos(alpha)*xs(1)sin(alpha)*xs(2)d1; cos(alpha)*xs(1)sin(alpha)*xs(2)d2]; p_ls Jk \ yk; p_tls tls_solve(Jk, yk); p_rctls rctls_solve(Jk, yk, lambda); err_ls(k) norm(p_ls - p_true); err_tls(k) norm(p_tls - p_true); err_rctls(k) norm(p_rctls - p_true); end fprintf(LS RMSE: %.2f m\n, sqrt(mean(err_ls.^2))); fprintf(TLS RMSE: %.2f m\n, sqrt(mean(err_tls.^2))); fprintf(RCTLS RMSE: %.2f m\n, sqrt(mean(err_rctls.^2)));把这段代码里的场景参数、噪声参数换成你自己论文里的配置就能复现大部分单站定位实验。代码讲解要连数据流一起看$J$ 和 $y$ 的每一行都来自带噪测量所以 LS 的假设从一开始就不成立TLS 和 RCTLS 的优势在 Monte Carlo 统计里会体现为 RMSE 的明显下降。4. RCTLS 的 4 个必调参数正则化系数、加权矩阵与收敛设置4.1 正则化参数 λL 曲线选点与经验量级$\lambda$ 是 RCTLS 里最敏感的参数。实际调试时我会先固定一个场景扫描 $\lambda$ 从 $10^{-8}$ 到 $10^2$ 的取值画出 $|Jp-y|$ 对 $|p|$ 的曲线——也就是 L 曲线。$\lambda$ 偏小时解范数大残差小但方差大$\lambda$ 偏大时解范数被压住残差增大出现明显偏差。L 曲线的拐角处曲率最大那一点对应的 $\lambda$ 就是折中值。% L 曲线选点扫描 lambda画 residual-norm 对 solution-norm lambdas logspace(-8, 2, 30); resid_norm zeros(size(lambdas)); sol_norm zeros(size(lambdas)); for i 1:numel(lambdas) x rctls_solve(J, y, lambdas(i)); resid_norm(i) norm(J*x - y); sol_norm(i) norm(x); end loglog(sol_norm, resid_norm, o-);如果不想每次都画图有一个省事的经验公式$\lambda_0 10^{-6}\cdot|J|_F^2$其中 $|J|_F$ 是 Frobenius 范数。这个量级在目标距离数千米、$J$ 元素为 1 量级的场景下表现稳定。注意这个公式只是起点正式做实验前还是要用 L 曲线确认一遍因为几何退化程度不同最优 $\lambda$ 会差几个数量级。4.2 加权矩阵让 DOA 噪声和 TDOA 噪声在同一个量纲下比较我在第 3 章的代码里没有加权但实际跑出来的结果往往有一条规律TDOA 测得很准纳秒级DOA 测得不差零点几度但定位误差仍然很大。原因是两者对最终解的影响量级不匹配。0.5 度的 DOA 误差在 3 公里距离上折算成横向距离误差约 26 米而 5 纳秒的 TDOA 误差只折算成 1.5 米。如果直接把两行方程叠在一起TDOA 这条信息几乎被 DOA 噪声主导相当于只用了方向没用到时差。解决办法是加权。给每个方程行的残差除以该行的等效噪声标准差等价于在目标函数里引入对角权重矩阵 $W$$F(p)\frac{|W(Jp-y)|^2}{1|p|^2}\lambda|p|^2$实现时不必改求解器只要对 $J$ 和 $y$ 左乘 $W$ 再调用 rctls_solve 就行。权重按经验设DOA 行的等效距离噪声 $\sigma_{eq}d\cdot\sigma_\alpha$TDOA 行用 $c\cdot\sigma_\tau$。$d$ 可以用一次 LS 解先估出来代入权重后再跑 RCTLS。这个两遍处理的做法在论文里也常见不算偷懒。4.3 迭代、收敛与初值RCTLS 的数值稳定性设置RCTLS 目标函数非凸初值决定了最后收敛到哪个局部极小点。我一般把关卡设在初值上第一优先级是岭回归初值它比 LS 初值在病态时更稳第二优先级是四方向重试即从 $x_0$、$x_0[\Delta,0]^T$、$x_0[0,\Delta]^T$、$x_0-[\Delta,\Delta]^T$ 四个点分别迭代取最终目标函数值最小的解。这里的 $\Delta$ 取场景尺度的千分之一比如场景 3 公里就取 3 米。这个技巧在目标接近几何退化区域时特别管用。回溯线搜索的参数我固定用充分下降系数 $10^{-4}$、步长衰减因子 0.5。最大迭代次数 200 次足够让梯度降到 $10^{-12}$ 量级迭代终止阈值 $10^{-10}$ 对坐标解来说已经是过度收敛了主要作用是防止在极小点附近做无用功。如果你的场景坐标是经纬度量级 $10^6$记得把这两个阈值按比例放大否则收敛判据可能被浮点误差卡住。4.4 一张参数表从 λ 到 Monte Carlo 次数参数推荐值说明$\sigma_\alpha$0.1°~2°典型阵列测向精度小于 0.1° 时噪声基本由多径衰落主导$\sigma_\tau$1~50 ns相关峰值时差估计受带宽和信噪比影响$\lambda$$10^{-6}||J||_F^2$L 曲线拐角最大不超过 $J$ 最大奇异值的 $10^{-2}$ 倍加权矩阵 $W$每行除以其等效噪声标准差DOA 行用 $d\sigma_\alpha$TDOA 行用 $c\sigma_\tau$max_iter200梯度降到 $10^{-12}$ 所需迭代次数的两倍安全量tol$10^{-10}$坐标量级为 $10^3$ 时的经验值按场景坐标量级缩放Monte Carlo 次数200~500少于 100 次时 RMSE 抖动明显500 次以上曲线稳定这张表不是拍脑袋是拿第 3 章代码跑了不同信噪比组合后得到的行为规律。$\lambda$ 和 $W$ 是唯一需要逐场景调整的两项其余参数一套配置可以用到整个实验序列里。5. RCTLS 复现翻车记录5 个让结果崩掉的问题与排查5.1 现象一DOA 误差在小偏置几何下被放大成百米级偏差有次我把反射点放在离观测站只有 200 米的位置目标在 3 公里外RCTLS 单次定位误差直接飙到 400 米而换一个反射点布局就恢复正常。查了很久才发现是 $d_i$ 计算公式里的分母 $s_ir_i$ 出了问题。$s_iu^T(x_s-x_{r,i})$ 是观测站到反射点矢量在目标方向上的投影反射点离观测站很近时这个投影和 $r_i$ 几乎大小相等、符号相反分母趋近于零DOA 测量误差在这个除法中被放大了一个数量级以上。解决方式很简单在计算 $d_i$ 之前检查 $|s_ir_i|$如果小于某个阈值比如场景尺度的 $10^{-3}$ 倍就丢弃这条 TDOA 路径只用 DOA 和另一条 TDOA 定位。这不是算法退步而是明确告诉模型这条路径的几何条件已经差到测量值无法提供有效信息的程度。5.2 现象二TDOA 符号反了目标直接跑到镜像位置$\tau$ 的定义在不同论文里不统一。有的定义直达径到达时间减去反射径到达时间有的反过来。我在复现早期就吃过亏第 2.1 节的推导默认的是正值直达径先到用的是 $r_ic\tau_i$反射径长度是 $d-r_i$。如果代码里 $\tau$ 符号相反$r_i$ 变成负值$d_i$ 计算出的距离会错误地偏大定位结果跑到相对反射点的镜像位置。排查方法很简单先用真实无噪的 $\alpha$ 和 $\tau$ 跑一遍单次定位如果误差不是零先看是不是符号问题而不是求解器问题。这个自检步骤应该写进主程序开头堪称后悔药。5.3 现象三λ 取大了RMSE 反而比 LS 还差这是最让人沮丧的情况RCTLS 是改进算法结果不如 LS那论文怎么写得下去。有一次我把 $\lambda$ 固定成 1目标距离 3 公里解被正则项拉向原点定位结果系统性偏近Monte Carlo 的 RMSE 比 LS 还大 30%。看 L 曲线才明白这个场景的最优 $\lambda$ 在 $10^{-5}$ 附近1 已经属于强正则化区间。解决思路是不要把 $\lambda$ 当成一个固定常数去调而是每换一组噪声参数就重新画一次 L 曲线。RCTLS 里 $\lambda$ 的量级由 $|J|$ 决定噪声水平变了$\lambda$ 的合理区间也跟着变。给 $\lambda$ 设置一个与 $|J|_F^2$ 成比例的基准值再在这个基准值附近做小范围扫描比直接手调稳定得多。5.4 现象四量纲不匹配让奇异值分解直接失效DOA 方程的量级是 1三角函数值TDOA 方程转成距离后量级是 $10^3$ 甚至 $10^4$。把它们直接叠进同一个 $J$ 后SVD 分解和梯度计算会本能地优先拟合那些数值大的行小量级的 DOA 约束几乎被忽略。TLS 的最小奇异值向量也被带偏RCTLS 的正则化项实际惩罚的只剩大数坐标。解决方式是尺度归一化。把距离量纲的行除以一个特征长度 $D_0$比如观测站到场景中心的粗略距离解出 $p$ 后再乘回 $D_0$。这样每个方程行的量级都归一到 1 附近SVD 分解和梯度下降才真正对所有方程一视同仁。第 3 章代码里 $y$ 的量级混着 $10^3$ 和 1跑通可以做精细实验前必须先做这一步。5.5 现象五结果依赖初值换一个场景就收敛到局部极小RCTLS 目标函数非凸局部极小点的存在和 $\lambda$ 大小相关。$\lambda$ 很小的时候目标函数接近纯 TLS 的瑞利商非凸性明显$\lambda$ 很大时又变成强凸但解偏差也大。我在某个场景下用岭回归初值能收敛到好结果换一个反射点布局后同一个初值策略就失效了定位误差大得离谱。解决方式是 4.3 节提过的四方向重试。四个初值分别迭代取目标函数值最小的解。这个策略把非凸优化的风险降低了一个量级代价是计算量乘四倍。单站定位场景的方程规模只有 3×2四倍计算量微乎其微但收敛稳定性收益很大。6. 性能验证的最后一公里CRLB、RMSE 曲线与误差椭圆6.1 用 CRLB 判断算法距离理论下界有多远复现论文时如果只给三条 RMSE 曲线审稿人和你自己都会觉得少了点什么。把 CRLB克拉美-罗界画上去才能说明 RCTLS 的性能余量。CRLB 计算需要观测模型关于目标位置的雅可比矩阵数值差分就足够% 数值法计算 CRLB观测函数 h(p) [alpha; tau1; tau2] h (p) [atan2(p(2)-xs(2), p(1)-xs(1)); (norm(p-xs)-norm(p-xr1))/c; (norm(p-xs)-norm(p-xr2))/c]; H zeros(3, 2); dp 1.0; % 差分步长按坐标量级取 for j 1:2 e zeros(2,1); e(j) dp; H(:, j) (h(p_truee) - h(p_true-e)) / (2*dp); end W diag([1/sigma_alpha^2, 1/sigma_tau^2, 1/sigma_tau^2]); FIM H * W * H; crlb trace(inv(FIM));把 CRLB 开根号后和 RMSE 画在同一张图里横轴是 $\sigma_\alpha$ 或 $\sigma_\tau$纵轴是定位误差。如果 RCTLS 曲线离 CRLB 在 2~3 倍以内说明算法已经榨干了测量信息如果差一个数量级先去检查加权矩阵是不是没设对而不是继续调 $\lambda$。6.2 画误差椭圆比只看 RMSE 更能暴露系统偏差RMSE 是一个标量会把不同方向的误差混在一起。定位误差往往不是各向同性的——TDOA 约束强的方向误差小DOA 约束强的方向误差大。把 Monte Carlo 的定位结果散点画出来对协方差矩阵做特征值分解两个特征值对应误差椭圆的长短轴特征向量给出椭圆朝向。如果椭圆中心不在真实目标点上说明存在系统性偏差这时回头检查 $d_i$ 公式或者 $\lambda$ 的偏差影响。这也是我复现这类定位算法的习惯先看几何再看统计先跑单次再跑批量。论文里那些漂亮的 RMSE 曲线背后通常都藏着几何条件、正则化参数和加权矩阵的反复折腾。RCTLS 不是银弹但它确实把 LS 在系数噪声下无能为力的那部分误差吃掉了。希望帮到你。本文还有配套的精品资源点击获取