GDOP 雷达定位精度分析

雷达定位精度分析，绘制GDOP图，研究雷达布阵形式！

%%% u    目标真实位置
%%% s    观测站坐标
%%% Qa   AOA估计的协方差矩阵
%%% Qb   自定位测量的协方差矩阵
function [rms cu] = crlb_AOA（usQaQbvarargin）

M = size（s2）;   %sensor个数
r = pdist2（s‘ u‘）; %source和sensors之间的真实距离
r2 = r.^2;
t_u = zeros（2M）;
t_s = zeros（2*MM）;
for i=1:M
   t_u（1i） = （s（2i）-u（2））/r2（i）;
   t_u（2i） = -（s（1i）-u（1））/r2（i）;
   t_s（2*i-1i） = -（s（2i）-u（2））/r2（i）;
   t_s（2*ii） = （s（1i）-u（1））/r2（i）;
end
X = t_u/Qa*t_u‘;
% X_1 = inv（X）;
X_1 = eye（size（X））/X;

if nargin < 4 %没设定Qb说明没有站址误差
   cu = X_1;
   rms = sqrt（sum（diag（cu）））;
else
   %%%有观测误差的话
   Y = t_u/Qa*t_s‘;
   Z = t_s/Qa*t_s‘ + eye（size（Qb））/Qb;
   cu =  X_1 + X_1*Y/（Z-Y‘*X_1*Y）*Y‘*X_1;
   rms = sqrt（sum（diag（cu）））;
end

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     目录           0  2014-01-13 17:29  GDOP\
     目录           0  2014-01-13 17:29  GDOP\2D\
     文件         774  2013-07-09 11:28  GDOP\2D\crlb_AOA.m
     文件        3319  2013-08-09 14:59  GDOP\2D\test2.m
     文件        2298  2013-08-09 15:24  GDOP\2D\test2_1.m
     目录           0  2014-01-13 17:29  GDOP\3D\
     文件         742  2013-08-12 09:22  GDOP\3D\check.m
     文件         615  2013-11-01 08:58  GDOP\3D\check_2.m
     文件         963  2013-08-10 18:39  GDOP\3D\crb_angle.m
     文件        1054  2013-04-16 10:08  GDOP\3D\crb_angle_range.m
     文件         532  2013-11-01 08:25  GDOP\3D\crb_range.m
     文件     1817952  2012-07-19 10:55  GDOP\3D\dandao_newvg200.mat
     文件        2342  2013-11-01 08:54  GDOP\3D\gdop_all.m