一阶相位差法进行导频估计多普勒matlab代码

% 一阶相位差法进行导频估计多普勒matlab代码
% 假设接收到的信号为x，导频序列为p
% fs为采样率，N为信号长度，f为多普勒频移

function f_est = phase_difference_est(x, p, fs, N)

% 一阶相位差法进行导频估计多普勒
% 假设接收到的信号为x，导频序列为p
% fs为采样率，N为信号长度，f为多普勒频移

% 先对信号和导频进行归一化
x = x./norm(x);
p = p./norm(p);

% 计算信号和导频的互相关函数
r = xcorr(x, p);

% 由于信号和导频的长度相差很大，因此互相关函数的长度也很大
% 我们只需要取互相关函数的中间部分即可
r = r(N:end);

% 计算互相关函数的一阶差分
dr = diff(r);

% 找到一阶差分的最大值位置
[~, idx] = max(abs(dr));

% 计算多普勒频移
f_est = fs*idx/N;

end