2019-04-18 14:15:24 -05:00
|
|
|
subroutine subtractft4(dd,itone,f0,dt)
|
|
|
|
|
|
|
|
|
|
! Subtract an ft4 signal
|
|
|
|
|
!
|
|
|
|
|
! Measured signal : dd(t) = a(t)cos(2*pi*f0*t+theta(t))
|
|
|
|
|
! Reference signal : cref(t) = exp( j*(2*pi*f0*t+phi(t)) )
|
|
|
|
|
! Complex amp : cfilt(t) = LPF[ dd(t)*CONJG(cref(t)) ]
|
|
|
|
|
! Subtract : dd(t) = dd(t) - 2*REAL{cref*cfilt}
|
|
|
|
|
|
|
|
|
|
use timer_module, only: timer
|
|
|
|
|
|
2019-05-22 17:02:15 -05:00
|
|
|
parameter (NMAX=21*3456,NSPS=576,NFFT=NMAX,NFILT=1400)
|
|
|
|
|
parameter (NFRAME=(103+2)*NSPS)
|
2019-04-18 14:15:24 -05:00
|
|
|
real*4 dd(NMAX), window(-NFILT/2:NFILT/2), xjunk
|
|
|
|
|
complex cref,camp,cfilt,cw
|
2019-04-18 14:16:39 -05:00
|
|
|
integer itone(103)
|
2019-04-18 14:15:24 -05:00
|
|
|
logical first
|
|
|
|
|
data first/.true./
|
2019-12-11 10:16:48 -06:00
|
|
|
common/heap4/cref(NFRAME),camp(NMAX),cfilt(NMAX),cw(NMAX),xjunk(NFRAME)
|
2019-04-18 14:15:24 -05:00
|
|
|
save first
|
|
|
|
|
|
2019-05-22 17:02:15 -05:00
|
|
|
nstart=dt*12000+1-NSPS
|
2019-04-18 14:16:39 -05:00
|
|
|
nsym=103
|
2019-04-18 14:15:24 -05:00
|
|
|
fs=12000.0
|
|
|
|
|
icmplx=1
|
2019-04-18 14:16:39 -05:00
|
|
|
bt=1.0
|
2019-05-22 17:02:15 -05:00
|
|
|
nss=NSPS
|
|
|
|
|
call gen_ft4wave(itone,nsym,nss,fs,f0,cref,xjunk,icmplx,NFRAME)
|
2019-04-18 14:15:24 -05:00
|
|
|
camp=0.
|
|
|
|
|
do i=1,nframe
|
|
|
|
|
id=nstart-1+i
|
|
|
|
|
if(id.ge.1.and.id.le.NMAX) camp(i)=dd(id)*conjg(cref(i))
|
|
|
|
|
enddo
|
|
|
|
|
|
|
|
|
|
if(first) then
|
|
|
|
|
! Create and normalize the filter
|
|
|
|
|
pi=4.0*atan(1.0)
|
|
|
|
|
fac=1.0/float(nfft)
|
|
|
|
|
sum=0.0
|
|
|
|
|
do j=-NFILT/2,NFILT/2
|
|
|
|
|
window(j)=cos(pi*j/NFILT)**2
|
|
|
|
|
sum=sum+window(j)
|
|
|
|
|
enddo
|
|
|
|
|
cw=0.
|
|
|
|
|
cw(1:NFILT+1)=window/sum
|
|
|
|
|
cw=cshift(cw,NFILT/2+1)
|
|
|
|
|
call four2a(cw,nfft,1,-1,1)
|
|
|
|
|
cw=cw*fac
|
|
|
|
|
first=.false.
|
|
|
|
|
endif
|
|
|
|
|
|
|
|
|
|
cfilt=0.0
|
|
|
|
|
cfilt(1:nframe)=camp(1:nframe)
|
|
|
|
|
call four2a(cfilt,nfft,1,-1,1)
|
|
|
|
|
cfilt(1:nfft)=cfilt(1:nfft)*cw(1:nfft)
|
|
|
|
|
call four2a(cfilt,nfft,1,1,1)
|
|
|
|
|
|
|
|
|
|
! Subtract the reconstructed signal
|
|
|
|
|
do i=1,nframe
|
|
|
|
|
j=nstart+i-1
|
|
|
|
|
if(j.ge.1 .and. j.le.NMAX) dd(j)=dd(j)-2*REAL(cfilt(i)*cref(i))
|
|
|
|
|
enddo
|
|
|
|
|
|
|
|
|
|
return
|
|
|
|
|
end subroutine subtractft4
|
|
|
|
|
|
