无源定位2

clc
clear all
%相位内插法
Fs=1024; %%采样率
N=2^9;
n=0:N-1;
t=n/Fs; %%时长
angle1=pi/2; angle2=pi/4;
f1=341;
%noise=sqrt(1)randn(1,N)+1isqrt(1)*randn(1,N);

x=exp(1i2pif1t+angle1);
x=awgn(x,0);

f2=300;
nn=N/2:3/2N-1;
tt=nn/Fs;
x_delay=exp(1i2pif2*tt+angle2);
x_delay=awgn(x_delay,0);

y=x./x_delay;
y1=y(1:N/2);
y2=y(N/2+1:N);
y1fft=fft(y1,N/2);
y2fft=fft(y2,N/2);
[a1,b1]=max(y1fft);
f1max=(b1-1)*Fs/(N/2) %最大谱线粗测评频率
[a2,b2]=max(y2fft);
ph1=angle(y1fft(1:N/2));
ph2=angle(y2fft(1:N/2));
b1
b2

angle11=ph1(b1); %y1信号在最大谱线处的相位
angle22=ph2(b2);
angle=angle22-angle11; %%得出两段信号在DFT最大谱线处的相位差
f_err=angle/(2*pi)2Fs/N %对ff与最大谱线估计的频率的偏差进行估计
f_est=f_err+f1max %估计的频率