无源探测交汇定位Matlab仿真

admin

【代码名称】：无源探测交汇定位Matlab仿真

【代码介绍】：无源探测交汇定位Matlab仿真

【代码截图】：

1. clear;
   
2. clc;
   
3. close all;
   
4. 
   
5. 
   
6. % a = 45;
   
7. % b = 45;
   
8. % r = (b-a).*rand(1,1) + a;
   
9. % dis = 25e3;           %100km
   
10. tar_loc = [45 25e3]';  
    
11. targetloc = [ tar_loc(2)*sind( tar_loc(1) );tar_loc(2)*cosd( tar_loc(1) ) ]; % 目标x-y坐标位置
    
12. 
    
13. T = 60*5;
    
14. v = 100/3.6;
    
15. thetaAir = tar_loc(1) + 45;      % 飞机航向，单位°  acosd(10/25)
    
16. deltaT = 1;      % 每deltaT秒计算一个角度和距离
    
17. % initial_coor = 1000*rand(1,2);
    
18. initial_coor = [0 0];
    
19. 
    
20. rangeAir = v*deltaT:v*deltaT:v*T;    % 飞行位置向量
    
21. radarloc_x = rangeAir*sind(thetaAir);     % 无人机航向X轴坐标
    
22. radarloc_y = rangeAir*cosd(thetaAir);     % 无人机航向Y轴坐标
    
23. radarloc = [initial_coor(1)+radarloc_x;initial_coor(2)+radarloc_y];   % 无人机x-y坐标位置，单位km
    
24. sigma = 1;
    
25. 
    
26. 
    
27. figure(1);hold on;
    
28. plot(0,0,'xr','LineWidth',2);
    
29. plot(targetloc(1),targetloc(2),'pr','LineWidth',2);
    
30. plot(radarloc(1,:),radarloc(2,:),'-.b','LineWidth',0.5);
    
31. 
    
32. 
    
33. Ax = [];
    
34. Ay = [];
    
35. Ae = [];
    
36. 
    
37. 
    
38. for i = 1:T
    
39.     x1 = initial_coor(1);
    
40.     y1 = initial_coor(2);
    
41.     x2 = radarloc_x(i);
    
42.     y2 = radarloc_y(i);
    
43. 
    
44.     theta1 = atand((x2 -initial_coor(1))/(y2-initial_coor(2))) - tar_loc(1);
    
45.     theta2 = thetaAir - atand( ( x2 - targetloc(1) )./(  y2- targetloc(2) ) );
    
46.     theta2 = theta2 + sigma*randn(1,1);
    
47. 
    
48.     theta2 = smooth(theta2,500,'rloess');
    
49. 
    
50. 
    
51. 
    
52.     x = (x2.*tand(theta2) - x1.*tand(theta1) + y1 - y2)./(tand(theta2)-tand(theta1));
    
53.     y = (y1.*tand(theta2) - y2.*tand(theta1) + tand(theta1).*tand(theta2).*(x2-x1))./(tand(theta2)-tand(theta1));
    
54. 
    
55. 
    
56. 
    
57.     Ax = [Ax;x];
    
58.     Ay = [Ay;y];
    
59.     xx = [x;y]';
    
60. 
    
61.     error = dist_E(xx,targetloc');
    
62.     error
    
63.     error = error./tar_loc(2)*100;
    
64. 
    
65.     error
    
66. 
    
67.     Ae = [Ae;error];
    
68. 
    
69. 
    
70. 
    
71. end
    
72. figure(2);
    
73. plot(Ae);
    
74. title('误差变化');xlabel('时刻');ylabel('误差变化值');
    
75. axis([0,T,0,50]);
    
76. % ylim([0,100]);%确定Y轴的范围是-1到3
    
77. set(gca,'YTick',[0:5:50]); %改变y轴坐标间隔显示 这里间隔为2
    
78. 
    
79. 
    
80. figure(3);
    
81. subplot(2,1,1);
    
82. plot(Ax);hold on;
    
83. plot([0,300],[targetloc(1),targetloc(1)],'r' ,'linewidth',2);
    
84. plot([0,300],[targetloc(1)-0.05*tar_loc(2),targetloc(1)-0.05*tar_loc(2)],'b' ,'linewidth',1);
    
85. plot([0,300],[targetloc(1)+0.05*tar_loc(2),targetloc(1)+0.05*tar_loc(2)],'b' ,'linewidth',1);
    
86. title('x坐标变化');xlabel('时刻');ylabel('x坐标值');
    
87. axis([0,T,0,2e5]);
    
88. subplot(2,1,2);
    
89. plot(Ay);hold on;
    
90. plot([0,300],[targetloc(2),targetloc(2)],'r' ,'linewidth',2);
    
91. plot([0,300],[targetloc(2)-0.05*tar_loc(2),targetloc(2)-0.05*tar_loc(2)],'b' ,'linewidth',1);
    
92. plot([0,300],[targetloc(2)+0.05*tar_loc(2),targetloc(2)+0.05*tar_loc(2)],'b' ,'linewidth',1);
    
93. title('y坐标变化');xlabel('时刻');ylabel('y坐标值');
    
94. axis([0,T,0,2e5]);
    
95. 
    
96. 
    
97. 
    
98. function dist = dist_E(x,y)
    
99. dist = [x;y];
    
100. dist = pdist(dist); % 计算各行向量之间的欧式距离
     
101. end
     
102. 
     

复制代码

【代码下载】： _Intersection_localization.m (2.8 KB, 下载次数: 232)

2023-9-6 06:38 上传

点击文件名下载附件