GDOP定位算法的MATLAB仿真

clear,clc

tic

N=1;

R=[1*(pi/180)^2 0;0 1*(pi/180)^2;];

% 3个观测站的位置S1,S2,S3,目标位置为T
%%%%%%%%% 单位换算成公里!!!
S1=[0 30]*1000;S2=[ 0 -30]*1000;

xt=-41000:2000:41000;
yt=-41000:2000:41000;

S=[S1;S2];
%y1=tan(fe1)*(x-S1(1))+S1(2);%S1的测向射线
%y2=tan(fe2)*(x-S2(1))+S2(2);%S2的测向射线
%y3=tan(fe3)*(x-S3(1))+S3(2);%S3的测向射线
k=1;

for l=1:length(xt)
for j=1:length(yt)

rr1_2=(xt(l)-S(1,1))^2+(yt(j)-S(1,2))^2;
rr2_2=(xt(l)-S(2,1))^2+(yt(j)-S(2,2))^2;
% rr3_2=(xt(l)-S(3,1))^2+(yt(j)-S(3,2))^2;

H(1,1)=-(yt(j)-S(1,2))/rr1_2;H(1,2)=(xt(l)-S(1,1))/rr1_2;
H(2,1)=-(yt(j)-S(2,2))/rr2_2;H(2,2)=(xt(l)-S(2,1))/rr2_2;
% H(3,1)=-(yt(j)-S(3,2))/rr3_2;H(3,2)=(xt(l)-S(3,1))/rr3_2;

Px=pinv(H)*R*pinv(H');

gdop(l,j)=sqrt(Px(1,1)+Px(2,2));
regdop(l,j)=gdop(l,j)/(sqrt(xt(l)*xt(l)+yt(j)*yt(j)));

end
end

Q=[0.5 0.6 0.7 0.8 0.9 1 1.2 1.3 1.5 2 2.5 3 5 7 10];
figure(1);
pic1=contour(xt/1000,yt/1000,gdop'/1000,Q),clabel(pic1);
xlabel('X（Km）');ylabel('Y（Km）');title( 'GDOP(T_1R_2)（Km） ' );hold on ;
plot(S1(1,1)/1000,S1(1,2)/1000,'rP',S2(1,1)/1000,S2(1,2)/1000,'rP');
axis([-40,40,-40,40]);
grid on

W=[0.01 0.02 0.025 0.03 0.035 0.04 0.045 0.05 0.06 0.07 0.08 0.1 0.2 0.5 1 2];

figure(2);
pic2=contour(xt/1000,yt/1000,regdop',W),clabel(pic2);
xlabel('X（Km）');ylabel('Y（Km）');title( '相对GDOP(T_1R_2)' );hold on ;
plot(S1(1,1)/1000,S1(1,2)/1000,'rP',S2(1,1)/1000,S2(1,2)/1000,'rP');
axis([-40,40,-40,40]);
grid on

toc

D152

GDOP定位算法的MATLAB仿真相关推荐

基于RSSI定位算法的matlab仿真
up目录一.理论基础二.核心程序三.测试结果一.理论基础 Received Signal Strength Indication接收的信号强度指示,无线发送层的可选部分,用来判定链接质量,以及 ...
各种不同几何形状布局布阵下的GDOP相对值图matlab仿真
目录 1.算法描述 2.仿真效果预览 3.MATLAB核心程序 4.完整MATLAB 1.算法描述全球四大导航卫星系统包括:美国GPS.俄罗斯GLONASS(格洛纳斯).中国北斗和欧洲Galileo ...
【自适应盲均衡10】基于判决引导(Decision Directed)的多径衰落信道双模式盲均衡算法与MATLAB仿真(DD-CMA)
关注公号[逆向通信猿]更精彩!!! 引言判决反馈均衡器(Decision Feedback Equalizer, DFE)虽然能够避免线性FIR均衡器的噪声增强,适用于具有深度谱零点的信道均衡:但是 ...
【图像修复】基于深度学习的图像修复算法的MATLAB仿真
1.软件版本 matlab2021a 2.本算法理论知识在许多领域,人们对图像质量的要求都很高,如医学图像领域.卫星遥感领域等.随着信息时代的快速发展,低分辨率图像已经难以满足特定场景的需要.因此, ...
保留已经定位区域MATLAB,基于HSV肤色提取与连通区域过滤的人脸定位算法（Matlab）...
概述本篇记录了利用基于HSV颜色模型的肤色提取与连通区域过滤实现图片的人脸定位,附带知识的介绍略烦多,附带Matlab相关程序代码. 一.预备知识图像预处理 1.1 灰度化在RGB模型中,如果R ...
基于RFM-SCAN的图像配准算法的matlab仿真
目录 1.算法概述 2.仿真效果 3.MATLAB仿真源码 1.算法概述这些匹配点通常是基于描述符相似性创建的.为了实现这一目标,现有的尝试通常涉及在几何约束下估计图像变换,其中需要预定义的变换模型 ...
基于免疫算法的认知无线电资源分配优化算法的matlab仿真
目录 1.算法描述 2.仿真效果预览 3.MATLAB核心程序 4.完整MATLAB 1.算法描述认知无线电(CR)的概念来自Joseph Mitolo博士1999年的开创性工作.它自适应地调整内部 ...
基于SURF特征提取的图像配准算法的matlab仿真
目录 1.算法概述 2.仿真效果 3.MATLAB仿真源码 1.算法概述 SURF,全称Speeded-up Robust Feature,是SIFT算法的改进版和加速版,综合性能更优.由Herber ...
基于NSGAII的多目标遗传优化算法的matlab仿真
目录 1.算法概述 2.仿真效果 3.MATLAB仿真源码 1.算法概述在遗传算法在解决多目标优化遇到瓶颈时,许多学者花费了不少时间和精力在多目标优化的遗传算法上,Goldberg首先将Pareto ...

GDOP定位算法的MATLAB仿真

GDOP定位算法的MATLAB仿真相关推荐

最新文章

热门文章