close all;clearvars;clc;dbstop if error;fid = fopen('tempiqa1.dat' , 'w+');%% 模拟目标运动轨迹以及天线的基本参数Pt = 10e-3; %发送信号功率wGt = 10; %天线增益 dbRCS =1.5; %取汽车的典型值,反射物的横截面积 平方米ADCsamplef1 = 2e6; %ADC采样率,主要是由于其中存在等待,为了保证时长的准确,此处chirp时长为8us ; 其中3us采样,5us等待Framet = 50e-3; %扫频间隔为50msc = 3E8;lambda = 3E8/77E9;Aeff = lambda/2 * 0.04; %接受天线的有效面积m^2numRxAnnate = 4; %接收天线个数d = lambda/2;DistanceOfEachAnnate = [0 d 2*d 3*d]; %接收天线间距,以第一幅接收天线为0,以后每一段为两幅接收天线之间的间距;% sction1 距离精度高,速度精度低段SampleRsec1 = 16;SampleVsec1 = 1024;Bandsec1 = 20E6;T1 = 1/ADCsamplef1*(SampleRsec1);U1 = Bandsec1/T1;DR1 = c/ 2 / Bandsec1;DV1 = lambda/ 2 / T1 / SampleVsec1;t1 = [0:SampleRsec1-1]/ADCsamplef1;F1 = zeros(SampleVsec1,SampleRsec1);% sction2 距离精度高,速度精度低段ADCsamplef2 = 5.4e6; %ADC采样率,主要是由于其中存在等待,为了保证时长的准确,此处chirp时长为47us ; 其中42us采样,5us等待SampleRsec2 = 256;SampleVsec2 = 128;Bandsec2 = 800e6;T2 = 1/ADCsamplef2*(SampleRsec2);U2 = Bandsec2/T2;DR2 = c/ 2 / Bandsec2;DV2 = lambda/ 2 / T2 / SampleVsec2;t2 = [0:SampleRsec2-1]/ADCsamplef2;F2 = zeros(SampleVsec2,SampleRsec2);% 目标回波信号Frame = 300; %至少要大于目标的帧数TargetNumber = 3; %回波目标个数TargerFrameOrignalMatrix = [Frame Frame Frame]; %如果目标出现帧数帧数超出,则目标被删除TargerRangeOrignalMatrix = [25 5 13]; %m 距离TargerVolectyOrignalMatrix = [10 12 18]; %m/s 速度为正表示远离 , 速度为负表示靠近TargerAccelerationOrignalMatrix = [0 1 5]; %m/s ^2TargerRoadOrignalMatrix = [2 0 0]; %默认设定目标为直线运动,此处给出目标的车道位置,目标的角度信息由距离关系自动计算。其中0表示中间车道,左边为负右边为正Mode = 0;%% 信号模拟%目标信号建模Fk = [1 Framet;0 1];Bk = [(Framet^2)/2 Framet]';% 峰值点结构体定义peakout.point_r = 0;peakout.point_v = 0;peakout.I1 = 0;peakout.Q1 = 0;peakout.I2 = 0;peakout.Q2 = 0;peakout.I3 = 0;peakout.Q3 = 0;peakout.I4 = 0;peakout.Q4 = 0;peaknum = 3072;for i = 1 : TargetNumber %目标个数循环Targetdeta = zeros(2 ,Frame );Targetdeta(:,1) = [TargerRangeOrignalMatrix(i) TargerVolectyOrignalMatrix(i)]';for j = 2 : TargerFrameOrignalMatrix(i) %目标帧数循环Targetdeta(1:2,j) = Fk*Targetdeta(1:2,j-1) + Bk.*TargerAccelerationOrignalMatrix(i);Targetdeta(3,j) = asind(3.6*TargerRoadOrignalMatrix(i) / Targetdeta(1 , j));if (Targetdeta(1 , j) < 0)Targetdeta(1 , j) = 0;Targetdeta(2 , j) = 0;endendTarget(i).target = Targetdeta();Target(i).Pr = Pt*Gt./(4*pi.*Target(i).target(1,:).^2) .* RCS .* (1/4/pi./Target(i).target(1,:).^2.*Aeff);Target(i).sn = 1.e-24 * 800e6 * (32+(9/5)*25);endfigure;for i = 1 : TargetNumberplot(Target(i).target(1,:).*sind(Target(i).target(3,:)) , Target(i).target(1,:) , '*');hold on;end% 模拟回波时域信号h1 = figure;h2 = figure;h3 = figure;for cnt = 1 : Frameset(0,'CurrentFigure' , h3);for i = 1 : TargetNumberplot(cnt , Target(i).target(1,cnt) , 'o');hold on;xlabel('帧数');ylabel('距离');endif(mod(cnt,2) == 0)Mode = 1; %表示srsect1段 16*1024 20Mhz% 初始化天线存储内存for annatacnt = 1 : numRxAnnatesrsec1(annatacnt).RX = zeros( SampleVsec1 , SampleRsec1);endfor k = 1 :TargetNumberfor anrxcnt = 1 : numRxAnnatedphi(anrxcnt) = 2*pi*DistanceOfEachAnnate(anrxcnt)*sind(Target(k).target(3,cnt)) / lambda;end%sec1 段回波数据模拟for i=1:SampleVsec1for j=1:SampleRsec1R = Target(k).target(1,cnt) +Target(k).target(2,cnt)*(i-1)*T1 + Target(k).target(2,cnt)*t1(j);f = 2*R/lambda + 2*U1*R*t1(j)/c;w = 2*pi*f;F1(i,j) = w + (rand(1)-0.5)/0.1/180*pi;endendfor i=1:SampleVsec1for j=1:SampleRsec1w = F1(i,j);for anncnt = 1 : numRxAnnatesrsec1(anncnt).RX(i,j) = srsec1(anncnt).RX(i,j) +sqrt( Target(k).Pr(cnt))* exp(sqrt(-1)*(w + dphi(anncnt))) + (rand(1) - 0.5)* sqrt( Target(k).sn);% * %dphi(anncnt)endendendendsrsecrx1 = srsec1(1).RX';srsecrx2 = srsec1(2).RX';srsecrx3 = srsec1(3).RX';srsecrx4 = srsec1(4).RX';black_manR = blackman(SampleRsec1);black_manV = blackman(SampleVsec1)';SR1 = srsecrx1.*repmat(black_manR,1,SampleVsec1);SR1 = SR1.*repmat(black_manV,SampleRsec1,1);fft_data1_1d = fft(SR1,SampleRsec1);fft_data1_1d = fft_data1_1d';fft_data1_2d = fft(fft_data1_1d,SampleVsec1);abs_data1 = abs(fft_data1_2d);%SR2 = srsecrx2.*repmat(black_manR,1,SampleVsec1);SR2 = SR2.*repmat(black_manV,SampleRsec1,1);fft_data2_1d = fft(SR2,SampleRsec2);fft_data2_1d = fft_data2_1d';fft_data2_2d = fft(fft_data2_1d,SampleVsec1);abs_data2 = abs(fft_data2_2d);%SR3 = srsecrx3.*repmat(black_manR,1,SampleVsec1);SR3 = SR3.*repmat(black_manV,SampleRsec1,1);fft_data3_1d = fft(SR3,SampleRsec1);fft_data3_1d = fft_data3_1d';fft_data3_2d = fft(fft_data3_1d,SampleVsec1);abs_data3 = abs(fft_data3_2d);%SR4 = srsecrx4.*repmat(black_manR,1,SampleVsec1);SR4 = SR4.*repmat(black_manV,SampleRsec1,1);fft_data4_1d = fft(SR4,SampleRsec1);fft_data4_1d = fft_data4_1d';fft_data4_2d = fft(fft_data4_1d,SampleVsec1);abs_data4 = abs(fft_data4_2d);set(0,'CurrentFigure' , h1);mesh(abs_data1);title( strcat('一维20Mhz 16点 ; dr = ' , num2str(DR1) ,'m ; 二维1024点; dv = ' , num2str(DV1) , 'm/s'));xlabel('距离维');ylabel('速度维');elseMode = 2; %表示srsect1段 256*128 800Mhz% 初始化天线存储内存for annatacnt = 1 : numRxAnnatesrsec2(annatacnt).RX = zeros( SampleVsec2 , SampleRsec2);end%sec2 段回波数据模拟for k = 1 :TargetNumberfor anrxcnt = 1 : numRxAnnatedphi(anrxcnt) = 2*pi*DistanceOfEachAnnate(anrxcnt)*sind(Target(k).target(3,cnt)) / lambda;end%sec2 段回波数据模拟for i=1:SampleVsec2for j=1:SampleRsec2R = Target(k).target(1,cnt) +Target(k).target(2,cnt)*(i-1)*T2 + Target(k).target(2,cnt)*t2(j);f = 2*R/lambda + 2*U2*R*t2(j)/c;w = 2*pi*f;F2(i,j) = w + (rand(1)-0.5)/0.1/180*pi;endendfor i=1:SampleVsec2for j=1:SampleRsec2w = F2(i,j);for anncnt = 1 : numRxAnnatesrsec2(anncnt).RX(i,j) = srsec2(anncnt).RX(i,j) + sqrt( Target(k).Pr(cnt)) * exp(sqrt(-1)*(w + dphi(anncnt)))+ (rand(1) - 0.5)* sqrt( Target(k).sn);endendendendsrsecrx1 = srsec2(1).RX';srsecrx2 = srsec2(2).RX';srsecrx3 = srsec2(3).RX';srsecrx4 = srsec2(4).RX';black_manR = blackman(SampleRsec2);black_manV = blackman(SampleVsec2)';SR1 = srsecrx1.*repmat(black_manR,1,SampleVsec2);SR1 = SR1.*repmat(black_manV,SampleRsec2,1);fft_data1_1d = fft(SR1,SampleRsec2);fft_data1_1d = fft_data1_1d';fft_data1_2d = fft(fft_data1_1d,SampleVsec2);abs_data1 = abs(fft_data1_2d);%SR2 = srsecrx2.*repmat(black_manR,1,SampleVsec2);SR2 = SR2.*repmat(black_manV,SampleRsec2,1);fft_data2_1d = fft(SR2,SampleRsec2);fft_data2_1d = fft_data2_1d';fft_data2_2d = fft(fft_data2_1d,SampleVsec2);abs_data2 = abs(fft_data2_2d);%SR3 = srsecrx3.*repmat(black_manR,1,SampleVsec2);SR3 = SR3.*repmat(black_manV,SampleRsec2,1);fft_data3_1d = fft(SR3,SampleRsec2);fft_data3_1d = fft_data3_1d';fft_data3_2d = fft(fft_data3_1d,SampleVsec2);abs_data3 = abs(fft_data3_2d);%SR4 = srsecrx4.*repmat(black_manR,1,SampleVsec2);SR4 = SR4.*repmat(black_manV,SampleRsec2,1);fft_data4_1d = fft(SR4,SampleRsec2);fft_data4_1d = fft_data4_1d';fft_data4_2d = fft(fft_data4_1d,SampleVsec2);abs_data4 = abs(fft_data4_2d);set(0,'CurrentFigure' , h2);mesh(abs_data1);title( strcat('一维800Mhz 256点 ; dr = ' , num2str(DR2) ,'m ; 二维128点; dv = ' , num2str(DV2) , 'm/s'));xlabel('距离维');ylabel('速度维');end%% 找峰值点,并把峰值点传出来avemeans = mean(abs_data1)*1.5;avemeans = repmat(avemeans , size(abs_data1 , 1) , 1);peak_matrix = imregionalmax(abs_data1);peak_matrix = peak_matrix .* abs_data1;peak_matrix(peak_matrix < avemeans) = 0;peak_matrix = peak_matrix * 1e6;g_menxian = avemeans(1,:)*1e6;[point_r point_v]= find(peak_matrix > 0);len = length(point_r);if len > 3072len = 3072;endfor peakcnt = 1 : 3072peakout(peakcnt).point_r = 0; peakout(peakcnt).point_v=0;peakout(peakcnt).I1 = 0;peakout(peakcnt).Q1 = 0;peakout(peakcnt).I2 = 0; peakout(peakcnt).Q2 = 0;peakout(peakcnt).I3 = 0; peakout(peakcnt).Q3 = 0;peakout(peakcnt).I4 = 0; peakout(peakcnt).Q4 = 0;end%peak_matrix为峰值点位置 ; g_menxian为门限值,之后组帧数据传输出去for peakcnt = 1 : length(point_r)peakout(peakcnt).point_r = point_r(peakcnt);peakout(peakcnt).point_v = point_v(peakcnt);peakout(peakcnt).I1 = real(fft_data1_2d( point_r(peakcnt) , point_v(peakcnt))) * 1e6;peakout(peakcnt).Q1 = imag(fft_data1_2d( point_r(peakcnt) , point_v(peakcnt))) * 1e6;peakout(peakcnt).I2 = real(fft_data2_2d( point_r(peakcnt) , point_v(peakcnt))) * 1e6;peakout(peakcnt).Q2 = imag(fft_data2_2d( point_r(peakcnt) , point_v(peakcnt))) * 1e6;peakout(peakcnt).I3 = real(fft_data3_2d( point_r(peakcnt) , point_v(peakcnt))) * 1e6;peakout(peakcnt).Q3 = imag(fft_data3_2d( point_r(peakcnt) , point_v(peakcnt))) * 1e6;peakout(peakcnt).I4 = real(fft_data4_2d( point_r(peakcnt) , point_v(peakcnt))) * 1e6;peakout(peakcnt).Q4 = imag(fft_data4_2d( point_r(peakcnt) , point_v(peakcnt))) * 1e6;endfor peakcnt = 1 : 3072fwrite(fid, peakout(peakcnt).point_r , 'uint16');fwrite(fid, peakout(peakcnt).point_v , 'uint16');fwrite(fid, int16(peakout(peakcnt).I1) , 'int16');fwrite(fid, int16(peakout(peakcnt).Q1) , 'int16');fwrite(fid, int16(peakout(peakcnt).I2) , 'int16');fwrite(fid, int16(peakout(peakcnt).Q2) , 'int16');fwrite(fid, int16(peakout(peakcnt).I3) , 'int16');fwrite(fid, int16(peakout(peakcnt).Q3) , 'int16');fwrite(fid, int16(peakout(peakcnt).I4) , 'int16');fwrite(fid, int16(peakout(peakcnt).Q4) , 'int16');endpause(0.01);endfclose(fid);
发布者:全栈程序员-站长,转载请注明出处:https://javaforall.net/177015.html原文链接:https://javaforall.net
