相关时延估计方法测距

clc;
clear all;
close all;
f0=100;%频率100Hz
T=0.1;%脉冲长度100ms
fs=1000;%采样率1KHz
t=1/fs:1/fs:T;
S=exp(1i*2*pi*f0*t);%脉冲信号
figure(1);plot(t,abs(S));
xlabel('t');ylabel('S');title('CW信号幅值');


S0=[zeros(1,1000),S,zeros(1,900)];%从脉冲发射时刻开始计时2s,
                                  %其中第一秒刚好为信号遇到障碍物反射到达接收器的时间，
                                  %第二秒的前100毫秒为反射信号。
t0=1/fs:1/fs:2;
figure(2);plot(t0,abs(S0));
xlabel('t0');ylabel('S0');title('接收器2s内接收信号幅值（不含噪声）');

S1=awgn(S0,5);%加入白噪声，信噪比为5dB.
t1=1/fs:1/fs:2;
figure(3);plot(t1,real(S1));
xlabel('t1');ylabel('S1');title('接收器2s内接收信号幅值（含噪声）');

S2=xcorr(S,S1);%S与S1互相关
t2=1/fs:1/fs:3.999;
figure(4);plot(t2,real(S2));
xlabel('t2');ylabel('S2');title('CW信号与接收器2s内接收信号（含噪声）相关');

[M,p]=max(real(S2))%找相关后的信号最大值点