-
大小: 4KB文件類型: .rar金幣: 2下載: 6 次發(fā)布日期: 2021-06-18
- 語(yǔ)言: Matlab
- 標(biāo)簽: 運(yùn)動(dòng)模型??
資源簡(jiǎn)介
通過(guò)Matlab產(chǎn)生勻速直線運(yùn)動(dòng)、勻加速直線運(yùn)動(dòng)、勻速轉(zhuǎn)彎運(yùn)動(dòng)三種運(yùn)動(dòng)軌跡的點(diǎn)跡,并加入了雜波。相關(guān)參數(shù)可自行調(diào)整。

代碼片段和文件信息
?clc;
?clear?all;
?close?all;
%%?參數(shù)設(shè)置
N?=?1000;???%掃描次數(shù)
T?=?0.208;??%掃描周期
rmax=20000;?%畫(huà)圖半徑
%?初始運(yùn)動(dòng)方向?與x軸的夾角
v_theta1=-10;???
v_theta2=10;
v_theta3=0;
%?初始運(yùn)動(dòng)方向?與xy軸的夾角
v_phi1=0;???
v_phi2=0;
v_phi3=0;
%?目標(biāo)初始運(yùn)動(dòng)方向上的速度??
v1=50;
v2=20;
v3=60;
%?初始加速度?
a2=1;
%?轉(zhuǎn)彎運(yùn)動(dòng)的轉(zhuǎn)彎率
w3=0.003;
%?距離、方位角、俯仰角和徑向速度觀測(cè)標(biāo)準(zhǔn)差
sigma_r?=0.5;
sigma_theta?=0.02;
sigma_phi=0;
sigma_v=0;%0.2;
%?xyz軸的隨機(jī)變化?過(guò)程噪聲
sigma_ax=0.01;
sigma_ay=0.01;
sigma_az=0;
%?所考慮的正方形仿真區(qū)域內(nèi)的雜波平均數(shù)
renbuda?=2;
%?指定N次掃描的雜波個(gè)數(shù),每個(gè)周期的數(shù)目服從泊松分布,分布的均值由面積大小
%?以及單位面積內(nèi)雜波數(shù)的乘積確定
Noise?=?poissrnd(renbuda?1?N);?%N個(gè)數(shù)值,代表N次掃描每次的雜波個(gè)數(shù)?
%%?仿真產(chǎn)生3個(gè)目標(biāo)的航跡
%?[徑向距離?方位?俯仰?徑向速度]=[x0?y0?z0?v0?a/w?v_theta?v_phi?sigma_ax?sigma_ay?sigma_az?sigma_r?sigma_theta?sigma_phi?sigma_v?T?N?]
radar1?=?simutrack_cv(-7000????-3000?????0?v1?????v_theta1?v_phi1?sigma_ax?sigma_ay?sigma_az?sigma_r?sigma_theta?sigma_phi?sigma_v?T?N);
radar2?=?simutrack_ca(-13000?-1000??0?v2?a2?v_theta2?v_phi2?sigma_ax?sigma_ay?sigma_az?sigma_r?sigma_theta?sigma_phi?sigma_v?T?N);
radar3?=?simutrack_ct(-10000?-10000?0?v3?w3?v_theta3?v_phi3?sigma_ax?sigma_ay?sigma_az?sigma_r?sigma_theta?sigma_phi?sigma_v?T?N);
%%?加入雜波點(diǎn)
i?=?0;
for?k?=?Noise
????i?=?i?+?1;
????point(i).sample?=?[rand(k1)*(rmax-500)?rand(k1)*360?zeros(k1)?rand(k1)*200-100];
????point(i).sample?=?[?radar1(i:);?radar2(i:);?radar3(i:);??point(i).sample];
end
%%?繪制真實(shí)航跡圖和加入雜波點(diǎn)后的圖
figure(1);
subplot(121)
H=polar([02*pi][0rmax]);
set(H‘Visible‘‘off‘);
hold?on
polar(radar1(:2)/180*piradar1(:1)‘g.‘);
hold?on
polar(radar2(:2)/180*piradar2(:1)‘b.‘);
hold?on
polar(radar3(:2)/180*piradar3(:1)‘r.‘);
title(‘真實(shí)航跡圖‘);
legend(‘‘‘cv‘‘ca‘‘ct‘);
subplot(122)
H=polar([02*pi][0rmax]);
set(H‘Visible‘‘off‘);
for?i?=?1:N????
????hold?on
????polar(point(i).sample(:2)/180*pi?point(i).sample(:1)‘.‘);
end
title(‘觀測(cè)點(diǎn)跡圖‘)
?屬性????????????大小?????日期????時(shí)間???名稱
-----------?---------??----------?-----??----
?????文件???????2145??2018-12-27?11:22??模擬軌跡\Copy_of_simutrack.m
?????文件???????2542??2018-11-24?22:39??模擬軌跡\simutrack_ca.m
?????文件???????2130??2018-11-24?22:40??模擬軌跡\simutrack_ct.m
?????文件???????2313??2018-11-24?22:35??模擬軌跡\simutrack_cv.m
?????目錄??????????0??2018-12-27?11:23??模擬軌跡
-----------?---------??----------?-----??----
?????????????????9130????????????????????5
- 上一篇:VSB調(diào)制—matlab
- 下一篇:典型PI控制器
評(píng)論
共有 條評(píng)論