各种不同几何形状布局布阵下的GDOP相对值图
%布陣方式
clc; clear all; close all;
%%(1)直線形布站
s(:,:,1) = [-90 -60 -30 0 30 60 90;...
? ? 0 0 0 0 0 0 0]*1e3;
%%(2)楔形布站
s(:,:,2) = [-45 -30 -15 0 15 30 45;...
? ? -90*cos(pi/6) -60*cos(pi/6) -30*cos(pi/6) 0 -30*cos(pi/6) -60*cos(pi/6) -90*cos(pi/6)]*1e3;
%%(3)工字形布站
s(:,:,3) = [-30 0 30 0 -30 0 30;...
? ? 30 30 30 0 -30 -30 -30]*1e3;
%%(4)梯形布站
s(:,:,4) = [-30 0 30 -45 -15 15 45;...
? ? 0 0 0 -30*cos(pi/6) -30*cos(pi/6) -30*cos(pi/6) -30*cos(pi/6)]*1e3;
%%(5)圓形布站
r = 3.45714e4;
theta0=2*pi/7;
for i = 1:7%七部
? ? s(:,i,5)=[r*cos(theta0*i);r*sin(theta0*i)];
end
%%(6)十字形布站
s(:,:,6) = [-60 -30 0 30 60 0 0;...
? ? 0 0 0 0 0 30 -30]*1e3;
index_s = 2;%步戰形式編號
sd_angle = 2*pi/180; ? ?%方位角標準差
sd_zhanzhi = 10; ? ? ? %站址標準差
Qa = eye(size(s,2))*(sd_angle)^2; ? %方位角方差
% Qb = eye(size(s,2)*2)*sd_zhanzhi^2; ?
x = -400e3:10e3:400e3; y = -400e3:10e3:400e3;
for i = 1:81
? ? for j=1:81
? ? ? ? u = [x(i);y(j)];
? ? ? ? ? ? ? ? [rms1(j,i), ~] = crlb_AOA(u,s(:,:,index_s),Qa);%僅有測角誤差時的CRLB的絕對值
? ? ? ? ? ? ? ? rms2(j,i) = rms1(j,i)/norm(u);
% ? ? ? ? [rms1(j,i), ~] = crlb_AOA(u,s(:,:,index_s),Qa,Qb);
% ? ? ? ? rms2(j,i) = rms1(j,i)/norm(u);
? ? ? ? % ? ? ? ? diff_rms(j,i) = crlb_AOA1(u,s(:,:,1),Qa,Qb);
? ? end
end
figure(1)
switch index_s
? ? case 1
? ? ? ? title('直線形布陣時的GDOP圖');
? ? ? ? Q=[5 10 20 30 50 70 90 120 300]; ? %等位線標識數值
? ? case 2
? ? ? ? title('楔形布陣時的GDOP圖');
? ? ? ? Q=[5 10 20 30 50 70 90 120 300];
? ? case 3
? ? ? ? title('工字形布陣時的GDOP圖');
? ? ? ? Q=[5 10 20 30 50 70 90 120 300];
? ? case 4
? ? ? ? title('梯形布陣時的GDOP圖');
? ? ? ? Q=[5 10 20 30 50 70 90 120 300];
? ? case 5
% ? ? ? ? title('不存在平臺導航誤差且圓形布陣時的GDOP圖');
% ? ? ? ? Q=[1 3 5 7 9 12 15 17];
? ? ? ? title('圓形布陣時的GDOP圖');
? ? ? ? Q=[5 10 20 30 50 70 90 120 300]; ? ? ? ?
? ? case 6
? ? ? ? title('十字形布陣時的GDOP圖');
? ? ? ? Q=[5 10 20 30 50 70 90 120 300];
end
hold on;
[c,handle]=contour(x*1e-3,y*1e-3,rms1*1e-3,Q);
clabel(c,handle);hold on; ?%等位線標識
plot(s(1,:,index_s)*1e-3,s(2,:,index_s)*1e-3,'rd')
xlabel('x/km'); ylabel('y/km');
figure(2)
switch index_s
? ? case 1
? ? ? ? title('直線形布陣時的GDOP相對值圖');
? ? ? ? Q=[0.04 0.05 0.06 0.07 0.08 0.09 0.1 0.12 0.15 0.17 0.2 0.3 0.5];
? ? case 2
? ? ? ? title('楔形布陣時的GDOP相對值圖');
? ? ? ? Q=[0.04 0.05 0.06 0.07 0.08 0.09 0.1 0.12 0.15 0.17 0.2 0.3 0.5];
? ? case 3
? ? ? ? title('工字形布陣時的GDOP相對值圖');
? ? ? ? Q=[0.04 0.05 0.06 0.07 0.08 0.09 0.1 0.12 0.15 0.17 0.2 0.3 0.5];
? ? case 4
? ? ? ? title('梯形布陣時的GDOP相對值圖');
? ? ? ? Q=[0.04 0.05 0.06 0.07 0.08 0.09 0.1 0.12 0.15 0.17 0.2 0.3 0.5];
? ? case 5
% ? ? ? ? title('不存在平臺導航誤差且圓形布陣時的GDOP相對值圖');
% ? ? ? ? Q=[0.005 0.01 0.018 0.025 0.045];
? ? ? ? title('圓形布陣時的GDOP相對值圖');
? ? ? ? Q=[0.04 0.05 0.06 0.07 0.08 0.09 0.1 0.12 0.15 0.17 0.2 0.3 0.5];
? ? case 6
? ? ? ? title('十字形布陣時的GDOP相對值圖');
? ? ? ? Q=[0.04 0.05 0.06 0.07 0.08 0.09 0.1 0.12 0.15 0.17 0.2 0.3 0.5];
end
hold on;[c,handle]=contour(x*1e-3,y*1e-3,rms2,Q);
clabel(c,handle);hold on;
plot(s(1,:,index_s)*1e-3,s(2,:,index_s)*1e-3,'rd')
xlabel('x/km'); ylabel('y/km');
D107
總結
以上是生活随笔為你收集整理的各种不同几何形状布局布阵下的GDOP相对值图的全部內容,希望文章能夠幫你解決所遇到的問題。
- 上一篇: 陆基制导系统地面站布设策略
- 下一篇: TDOA定位的Chan算法MATLAB源