clc;
clear?all;
close?all;
angle_rd_fw_start=0;%雷達(dá)天線波束起始方位角為0；
r_max=18e3;%雷達(dá)最大作用距離
r_min=5e3;%雷達(dá)最小作用距離
angle_rd_bandwidth=10/180*pi;%天線波束寬度4°
rd_speed=6/180*pi;%雷達(dá)波束掃描速度為3°/s

load?E:\line2.dat
v_m=line2（:1）‘;%目標(biāo)的速度大小
r_m=line2（:2）‘;%目標(biāo)初始的徑向距離
angle_m_fw=line2（:3）‘;%目標(biāo)初始的方位角
angle_v_fw=line2（:4）‘;%目標(biāo)初始的速度方位角
tgt_modle=line2（:5）‘;%目標(biāo)的運(yùn)動(dòng)模型

pos_x=r_m.*cos（angle_m_fw）;%根據(jù)上面的初始參數(shù)算出目標(biāo)的初始的X坐標(biāo)
pos_y=r_m.*sin（angle_m_fw）;%根據(jù)上面的初始參數(shù)算出目標(biāo)的初始的Y坐標(biāo)

m_num=length（r_m）;%求出飛機(jī)航跡的個(gè)數(shù)；

%%模擬器過(guò)程；
cpi_time=85e-2;%%對(duì)目標(biāo)航跡的采樣間隔時(shí)間，單位s?
z_time=300;%%設(shè)置雷達(dá)波束掃描的總時(shí)間，單位s
trace_length=ceil（z_time/cpi_time）;%%表示對(duì)目標(biāo)航跡采樣的總個(gè)數(shù)?
x_m_trace=zeros（m_numtrace_length）;%%設(shè)置一個(gè)m_num*trace_length放置m_num個(gè)航跡x坐標(biāo)的矩陣
y_m_trace=zeros（m_numtrace_length）;
angle_m_trace=zeros（m_numtrace_length）;%放置m_num個(gè)航跡的方位角
angle_rd_trace=zeros（1trace_length）;%放置雷達(dá)的方位角
angle_rd_trace（11）=angle_rd_fw_start;
n=60;?
angle_rd_trace1（1:n1）=（linspace（angle_rd_trace（11）-angle_rd_bandwidth/2angle_rd_trace（11）+angle_rd_bandwidth/2n））‘;
pos_x1=pos_x;
pos_y1=pos_y;

x_m_trace（1:m_num1）=pos_x‘;
y_m_trace（1:m_num1）=pos_y‘;

%?angle_m_trace1=pos_y/pos_x;%?????????????
%?if?pos_x<0%?????????
%????angle_m_trace1=angle_m_trace1+pi;
%?end
%?angle_m_trace（1:m_num1）=angle_m_trace1;
angle_m_fw=atan（pos_y./pos_x）;%%得到目標(biāo)的方位角，因?yàn)槭怯胊tan的函數(shù)求角，因此需要修正。
m0=find（pos_x<0）;
angle_m_fw（m0）=angle_m_fw（m0）+pi;
angle_m_trace（1:m_num1）=angle_m_fw‘;

m=1;
w=2;
while?m<=trace_length???%%進(jìn)入波束掃描
????for?i=1:4
????????if（tgt_modle（1i）==0）%航跡模型為直線
%?????????????[pos_jh_xpos_jh_y]=LINE（pos_x1pos_y1）;
????????????pos_jh_x（1i）=pos_x1（1i）+v_m（1i）.*cpi_time.*cos（angle_v_fw（1i））;%m個(gè)cpi時(shí)間間隔之后目標(biāo)的新坐標(biāo)
????????????pos_jh_y（1i）=pos_y1（1i）+v_m（1i）.*cpi_time.*sin（angle_v_fw（1i））;
????????else
????????????pos_jh_x（1i）=pos_x1（1i）+v_m（1i）./w.*cos（angle_m_fw（1i）+w.*cpi_time）;%m個(gè)cpi時(shí)間間隔之后目標(biāo)的新坐標(biāo)
????????????pos_jh_y（1i）=pos_y1（1i）+v_m（1i）./w.*sin（angle_m_fw（1i）+w.*cpi_time）;????????????
????????end
????end
????pos_r=sqrt（pos_jh_x.^2+pos_jh_y.^2）;
????R_sub=pos_r-r_max;
????r_sub=pos_r-r_min;
%?????R_sub>0;
????m_R=find（R_sub>0）;
????R=length（m_R）;
%?????r_sub<0;
????m_r=find（r_sub<0）;
????r=length（m_r）;
????%%%%%%%若目標(biāo)超出雷達(dá)最大作用距離，則目標(biāo)從起始點(diǎn)重新開(kāi)始運(yùn)動(dòng)%%%%%%%
????if??R
????????pos_jh_x（1m_R）=pos_x（1m_R）;
????????pos_jh_x（1m_R）=pos_y（1m_R）;
????end
????
????%%%%%%%若目標(biāo)超出雷達(dá)最小作用距離，則目標(biāo)從起始點(diǎn)重新開(kāi)始運(yùn)動(dòng)%%%%%%%?
%?????if??r
%????????pos_jh_x（1m_r）=pos_x（1m_r）;
%????????pos_jh_y（1m_r）=pos_y（1m_r）;
????????%pos_jh_z（1m_r）=pos_z（1m_r）;
%?????end
?????
????angle_m_fw=atan（pos_jh_y./pos_jh_x）;%%得到目標(biāo)的方位角，因?yàn)槭怯胊tan的函數(shù)求角，因此需要修正。
????m1=find（pos_jh_x<0）;
?