%%
%%
clc;
clear;
N=256;
f=50;
T=1/f;
fs=N*f;
Ts=1/N*T;
t=0:Ts:(2*N-1)*Ts;
y1=cos(2*pi*f*t)+0.05*cos(2*pi*41*f*t);
y2=cos(2*pi*f*t-1.98/4*pi)-0.4*cos(2*pi*41*f*t-1.98/4*pi);
% y1=cos(2*pi*10*f*t);
% y2=cos(2*pi*10*f*t);
figure;
stem(t,y1);
figure;
stem(t,y2);
detf= 1/720*pi;
% detf=0.02;
dett=detf/2/pi/f;
n=floor(dett/Ts);
t1=dett-n*Ts;
t2=(n+1)*Ts-dett;
y3=zeros(1,2*N);
y2p=cos(2*pi*f*t-1.98/4*pi-detf)-0.4*cos(2*pi*41*f*t-1.98/4*pi+1/180/100*pi);
% y2p=cos(2*pi*10*f*t+detf);
for ii=1:N
y3(ii)=(y2p(ii+n)*t2+y2p(ii+n+1)*t1)/(t1+t2);
end
for ii=N+1:2*N
y