Update Radar simulation
This commit is contained in:
Ksyer
@@ -0,0 +1,13 @@
|
||||
function y = R_d_func(t)
|
||||
global c f_n T_r;
|
||||
|
||||
ti = t - (2/c) * r(t);
|
||||
p = rem(ti, T_r); % p = t - nT_r
|
||||
n = round((ti - p) / T_r);
|
||||
|
||||
if (n < 0)
|
||||
n = 0;
|
||||
end
|
||||
|
||||
y = R_x_func(t) * exp(1j * -2 * pi * f_n(n + 1) * (t - n * T_r));
|
||||
end
|
||||
@@ -0,0 +1,5 @@
|
||||
function y = R_x_func(t)
|
||||
global scatter_coef c;
|
||||
ti = t - (2/c) * r(t);
|
||||
y = scatter_coef * T_x_func(ti);
|
||||
end
|
||||
@@ -0,0 +1,14 @@
|
||||
function y = T_x_func(t)
|
||||
global T_r T_p f_n;
|
||||
p = rem(t, T_r); % p = t - nT_r
|
||||
n = round((t - p) / T_r);
|
||||
|
||||
if (p > T_p)
|
||||
y = 0;
|
||||
elseif (p <= 0)
|
||||
y = 0;
|
||||
else
|
||||
y = exp(1j * 2 * pi * f_n(n + 1) * p);
|
||||
end
|
||||
|
||||
end
|
||||
@@ -0,0 +1,40 @@
|
||||
global M N K d epsilon f_c Delta_f c scatter_coef B f_s T_p T_r r_0 velocity lambda delta_t max_t range_t len freqs slow_len num_pulse
|
||||
|
||||
N = 128; % 脉冲个数
|
||||
M = 1; % 频点个数
|
||||
K = 10; % 目标个数
|
||||
d = 32;
|
||||
epsilon = 1e-5; % 误差
|
||||
|
||||
f_c = 10e9; % 初始载频 10GHz
|
||||
Delta_f = 8e6; % 载频步进间隔 8MHz
|
||||
% c = 299792458; % 光速
|
||||
c = 3e8;
|
||||
scatter_coef = 0.3; % 目标散射强度
|
||||
|
||||
B = 64e6; % 带宽 64MHz
|
||||
% B_0 = 1e9;
|
||||
|
||||
T_p = 1e-6 / 3; % 单载频脉冲下的采样周期 / 脉冲宽度
|
||||
f_s = 100 / T_p; % 快时间采样率
|
||||
T_r = T_p * 10;
|
||||
|
||||
r_0 = 30; % 初始距离 r(0)
|
||||
velocity = 3e2; % 目标速度（假设目标做匀速直线运动）
|
||||
lambda = c / f_c; % 雷达工作波长
|
||||
|
||||
% 仿真时间
|
||||
num_pulse = 100;
|
||||
delta_t = 1e-2 * T_p;
|
||||
max_t = num_pulse * T_r;
|
||||
range_t = 0:delta_t:max_t - delta_t;
|
||||
len = round(max_t / delta_t);
|
||||
|
||||
freqs = ((0:len - 1) * f_s) / len;
|
||||
|
||||
% 绘图
|
||||
figure_flag_1 = false;
|
||||
figure_flag_2 = false;
|
||||
figure_flag_3 = false;
|
||||
|
||||
slow_len = 1e4;
|
||||
@@ -0,0 +1,47 @@
|
||||
function v = get_doppler(s_T, s_R)
|
||||
global T_r delta_t c f_c velocity max_t slow_len;
|
||||
freq_s_T = 1 / T_r;
|
||||
|
||||
slow_freqs = ((0:slow_len - 1) * (1 / T_r)) / slow_len;
|
||||
range_t_slow = 1:slow_len;
|
||||
|
||||
num_slow = max_t / T_r;
|
||||
s_R_slow = zeros(1, slow_len);
|
||||
k = floor(T_r / delta_t);
|
||||
|
||||
init_idx = 1;
|
||||
|
||||
while abs(s_R(init_idx)) == 0
|
||||
init_idx = init_idx + 1;
|
||||
end
|
||||
|
||||
for i = 0:num_slow - 1
|
||||
|
||||
while abs(s_R(init_idx + i * k)) == 0
|
||||
init_idx = init_idx + 1;
|
||||
end
|
||||
|
||||
s_R_slow(i + 1) = s_R(init_idx + i * k);
|
||||
end
|
||||
|
||||
s_R_fft = fft(s_R_slow);
|
||||
[~, max_index_s_R] = max(s_R_fft);
|
||||
freq_s_R = slow_freqs(max_index_s_R);
|
||||
|
||||
figure(2);
|
||||
subplot(2, 1, 1);
|
||||
plot(range_t_slow, abs(s_R_slow));
|
||||
title(sprintf('s_R'));
|
||||
subplot(2, 1, 2);
|
||||
plot(slow_freqs, abs(s_R_fft));
|
||||
title(sprintf('s_R_fft, freq = %E', freq_s_R));
|
||||
xlabel('频率 (Hz)');
|
||||
|
||||
f_d = freq_s_T - freq_s_R;
|
||||
|
||||
fprintf("doppler_freq = %E\n\n", f_d);
|
||||
v = (c * f_d) / (2 * f_c);
|
||||
|
||||
fprintf("v: %E\norigin_velocity: %E\n", v, velocity);
|
||||
|
||||
end
|
||||
@@ -0,0 +1,19 @@
|
||||
function [range, range_idx] = get_range(s_T, s_R)
|
||||
global T_r delta_t len c r_0 range_t num_pulse;
|
||||
|
||||
% 只取第一个 T_r 的数据计算
|
||||
range_N = T_r / delta_t;
|
||||
s_T_first = [s_T(1:range_N), zeros(1, len - range_N)];
|
||||
s_R_first = [s_R(1:range_N), zeros(1, len - range_N)];
|
||||
|
||||
s_T_fft = fft(s_T_first, len);
|
||||
s_R_fft = fft(s_R_first, len);
|
||||
|
||||
% 发射信号和回波信号做相关
|
||||
p = ifft(s_R_fft .* conj(s_T_fft));
|
||||
norm_p = real(p).^2 + imag(p).^2;
|
||||
[~, range_idx] = max(norm_p);
|
||||
|
||||
range = range_t(range_idx) * c / 2;
|
||||
fprintf("range = %f, r_0 = %f\n", range, r_0);
|
||||
end
|
||||
@@ -0,0 +1,37 @@
|
||||
%%
|
||||
clc;
|
||||
clear;
|
||||
|
||||
config_parameters;
|
||||
|
||||
global C_n f_n;
|
||||
C_n = zeros(1, len);
|
||||
f_n = zeros(1, len);
|
||||
|
||||
for t_idx = 1:len
|
||||
C_n(t_idx) = floor(rand * (M - 1));
|
||||
f_n(t_idx) = f_c + C_n(t_idx) * Delta_f;
|
||||
end
|
||||
|
||||
T_x = zeros(1, len);
|
||||
R_x = zeros(1, len);
|
||||
R_d = zeros(1, len);
|
||||
|
||||
for i = 1:len
|
||||
t = range_t(i);
|
||||
T_x(i) = T_x_func(t);
|
||||
R_x(i) = R_x_func(t);
|
||||
R_d(i) = R_d_func(t);
|
||||
end
|
||||
|
||||
%%
|
||||
if false
|
||||
figure(5)
|
||||
plot(range_t, T_x, color="red");
|
||||
hold on;
|
||||
plot(range_t, R_d, color="blue");
|
||||
xlim([0, 10 * T_r])
|
||||
end
|
||||
|
||||
[r, range_idx] = get_range(T_x, R_x);
|
||||
doppler = get_doppler(T_x, R_d);
|
||||
@@ -0,0 +1,4 @@
|
||||
function x = r(t)
|
||||
global r_0 velocity;
|
||||
x = r_0 + velocity * t;
|
||||
end
|
||||
Reference in New Issue
Block a user