2015-12-18 14:58:10 -05:00
|
|
|
subroutine sync65(ss,nfa,nfb,naggressive,ntol,nhsym,ca,ncand,nrobust)
|
2015-11-17 20:28:12 -05:00
|
|
|
|
|
|
|
|
parameter (NSZ=3413,NFFT=8192,MAXCAND=300)
|
|
|
|
|
real ss(322,NSZ)
|
2015-11-25 11:40:22 -05:00
|
|
|
real ccfblue(-11:540) !CCF with pseudorandom sequence
|
2015-11-17 20:28:12 -05:00
|
|
|
real ccfred(NSZ) !Peak of ccfblue, as function of freq
|
|
|
|
|
|
|
|
|
|
type candidate
|
|
|
|
|
real freq
|
|
|
|
|
real dt
|
|
|
|
|
real sync
|
|
|
|
|
end type candidate
|
|
|
|
|
type(candidate) ca(MAXCAND)
|
|
|
|
|
|
|
|
|
|
common/steve/thresh0
|
|
|
|
|
|
|
|
|
|
call setup65
|
2015-12-18 14:58:10 -05:00
|
|
|
df=12000.0/NFFT !df = 12000.0/8192 = 1.465 Hz
|
2015-11-17 20:28:12 -05:00
|
|
|
ia=max(2,nint(nfa/df))
|
|
|
|
|
ib=min(NSZ-1,nint(nfb/df))
|
2015-11-25 11:40:22 -05:00
|
|
|
lag1=-11
|
2015-11-17 20:28:12 -05:00
|
|
|
lag2=59
|
|
|
|
|
nsym=126
|
|
|
|
|
ncand=0
|
|
|
|
|
fdot=0.
|
|
|
|
|
ccfred=0.
|
|
|
|
|
ccfblue=0.
|
2015-12-18 14:58:10 -05:00
|
|
|
ccfmax=0.
|
|
|
|
|
ipk=0
|
2015-11-17 20:28:12 -05:00
|
|
|
|
|
|
|
|
do i=ia,ib
|
|
|
|
|
call xcor(ss,i,nhsym,nsym,lag1,lag2,ccfblue,ccf0,lagpk0,flip,fdot,nrobust)
|
|
|
|
|
! Remove best-fit slope from ccfblue and normalize so baseline rms=1.0
|
|
|
|
|
call slope(ccfblue(lag1),lag2-lag1+1,lagpk0-lag1+1.0)
|
|
|
|
|
ccfred(i)=ccfblue(lagpk0)
|
2015-12-18 14:58:10 -05:00
|
|
|
if(ccfred(i).gt.ccfmax) then
|
|
|
|
|
ccfmax=ccfred(i)
|
|
|
|
|
ipk=i
|
|
|
|
|
endif
|
2015-11-17 20:28:12 -05:00
|
|
|
enddo
|
|
|
|
|
call pctile(ccfred(ia:ib),ib-ia+1,35,xmed)
|
|
|
|
|
ccfred(ia:ib)=ccfred(ia:ib)-xmed
|
|
|
|
|
ccfred(ia-1)=ccfred(ia)
|
|
|
|
|
ccfred(ib+1)=ccfred(ib)
|
|
|
|
|
|
|
|
|
|
do i=ia,ib
|
|
|
|
|
freq=i*df
|
|
|
|
|
itry=0
|
2015-12-18 14:58:10 -05:00
|
|
|
if(naggressive.gt.0 .and. ntol.lt.1000 .and. ccfmax.ge.thresh0) then
|
|
|
|
|
if(i.ne.ipk) cycle
|
2015-11-17 20:28:12 -05:00
|
|
|
itry=1
|
|
|
|
|
ncand=ncand+1
|
2015-12-18 14:58:10 -05:00
|
|
|
else
|
|
|
|
|
if(ccfred(i).ge.thresh0 .and. ccfred(i).gt.ccfred(i-1) .and. &
|
|
|
|
|
ccfred(i).gt.ccfred(i+1)) then
|
|
|
|
|
itry=1
|
|
|
|
|
ncand=ncand+1
|
|
|
|
|
endif
|
2015-11-17 20:28:12 -05:00
|
|
|
endif
|
|
|
|
|
if(itry.ne.0) then
|
|
|
|
|
call xcor(ss,i,nhsym,nsym,lag1,lag2,ccfblue,ccf0,lagpk,flip,fdot,nrobust)
|
|
|
|
|
call slope(ccfblue(lag1),lag2-lag1+1,lagpk-lag1+1.0)
|
|
|
|
|
xlag=lagpk
|
|
|
|
|
if(lagpk.gt.lag1 .and. lagpk.lt.lag2) then
|
|
|
|
|
call peakup(ccfblue(lagpk-1),ccfmax,ccfblue(lagpk+1),dx2)
|
|
|
|
|
xlag=lagpk+dx2
|
|
|
|
|
endif
|
|
|
|
|
dtx=xlag*2048.0/11025.0
|
|
|
|
|
ccfblue(lag1)=0.
|
|
|
|
|
ccfblue(lag2)=0.
|
|
|
|
|
ca(ncand)%freq=freq
|
|
|
|
|
ca(ncand)%dt=dtx
|
|
|
|
|
ca(ncand)%sync=ccfred(i)
|
|
|
|
|
endif
|
|
|
|
|
if(ncand.eq.MAXCAND) return
|
|
|
|
|
enddo
|
|
|
|
|
|
|
|
|
|
return
|
|
|
|
|
end subroutine sync65
|
