combfilt.m

来自「病号饭基本百分点你们不vcxnvcbvnx 再次向白菜帮子选择性村民在 在小板擦」· M 代码 · 共 31 行

function out=combfilt(signal,fs,fcut,alpha)
%OUT=COMBFILT(SIGNAL,FS,FCUT,ALPHA) where Signal is the array to be filtered
%	FS is the sampling frequency, FCUT is the cutoff frequency and ALPHA is 
%	is the ALPHA parameter.
%	This Function was supplied by www.PATENWorks.com

k=round(fs/fcut);
%set Feed Forward Gain
ffgain=1;
%Set Output Gain
outgain=-1;
%Set Alpha parameters gain
alphagain=alpha^k;
%Initialise Buffer
buffer=zeros(1,k);
count=1;
fb=0;
delay=0;
for a=1:length(signal)
    buffer(count)=signal(a)+fb;
    ff=buffer(count);
    fb=delay*alphagain;
    out(a)=-delay+ff;
    
    count=count+1;
    if count==k+1;
        count=1;
    end
    delay=buffer(count);
end