mirror of
https://github.com/saitohirga/WSJT-X.git
synced 2024-11-03 07:51:16 -05:00
6c50362ccc
git-svn-id: svn+ssh://svn.code.sf.net/p/wsjt/wsjt/branches/wsjtx@6731 ab8295b8-cf94-4d9e-aec4-7959e3be5d79
321 lines
8.8 KiB
Fortran
321 lines
8.8 KiB
Fortran
subroutine syncmsk144(cdat,npts,msgreceived,fest)
|
|
use iso_c_binding, only: c_loc,c_size_t
|
|
use packjt
|
|
use hashing
|
|
use timer_module, only: timer
|
|
|
|
parameter (NSPM=864)
|
|
character*22 msgreceived
|
|
character*85 pchk_file,gen_file
|
|
complex cdat(npts) !Analytic signal
|
|
complex c(NSPM)
|
|
complex ctmp(6000)
|
|
complex cb(42) !Complex waveform for sync word
|
|
complex csum,cfac,cca,ccb
|
|
complex cc(npts)
|
|
complex cc1(npts)
|
|
complex cc2(npts)
|
|
complex bb(6)
|
|
integer s8(8),hardbits(144),hardword(128),unscrambledhardbits(128)
|
|
integer*1, target:: i1Dec8BitBytes(10)
|
|
integer, dimension(1) :: iloc
|
|
integer*4 i4Msg6BitWords(12) !72-bit message as 6-bit words
|
|
integer*4 i4Dec6BitWords(12)
|
|
integer*1 decoded(80)
|
|
integer*1, allocatable :: message(:)
|
|
integer*1 i1hashdec
|
|
integer ipeaks(10)
|
|
logical ismask(6000)
|
|
real cbi(42),cbq(42)
|
|
real tonespec(6000)
|
|
real rcw(12)
|
|
real dd(npts)
|
|
real pp(12) !Half-sine pulse shape
|
|
real*8 dt, df, fs, pi, twopi
|
|
real softbits(144)
|
|
real*8 unscrambledsoftbits(128)
|
|
real lratio(128)
|
|
logical first
|
|
data first/.true./
|
|
|
|
data s8/0,1,1,1,0,0,1,0/
|
|
save first,cb,pi,twopi,dt,f0,f1
|
|
! save
|
|
if(first) then
|
|
! These files can be found in /lib/ldpc/jtmode_codes directory
|
|
pchk_file="peg-128-80-reg3.pchk"
|
|
gen_file="peg-128-80-reg3.gen"
|
|
call init_ldpc(trim(pchk_file)//char(0),trim(gen_file)//char(0))
|
|
! define half-sine pulse and raised-cosine edge window
|
|
pi=4d0*datan(1d0)
|
|
twopi=8d0*datan(1d0)
|
|
dt=1.0/12000.0
|
|
do i=1,12
|
|
angle=(i-1)*pi/12.0
|
|
pp(i)=sin(angle)
|
|
rcw(i)=(1-cos(angle))/2
|
|
enddo
|
|
|
|
! define the sync word waveform
|
|
s8=2*s8-1
|
|
cbq(1:6)=pp(7:12)*s8(1)
|
|
cbq(7:18)=pp*s8(3)
|
|
cbq(19:30)=pp*s8(5)
|
|
cbq(31:42)=pp*s8(7)
|
|
cbi(1:12)=pp*s8(2)
|
|
cbi(13:24)=pp*s8(4)
|
|
cbi(25:36)=pp*s8(6)
|
|
cbi(37:42)=pp(1:6)*s8(8)
|
|
cb=cmplx(cbi,cbq)
|
|
|
|
first=.false.
|
|
endif
|
|
|
|
! Coarse carrier frequency sync
|
|
! look for tones near 2k and 4k in the (analytic signal)**2 spectrum
|
|
! search range for coarse frequency error is +/- 100 Hz
|
|
fs=12000.0
|
|
nfft=6000 !using a zero-padded fft to get 2 Hz bins
|
|
df=fs/nfft
|
|
|
|
ctmp=cmplx(0.0,0.0)
|
|
ctmp(1:npts)=cdat**2
|
|
ctmp(1:12)=ctmp(1:12)*rcw
|
|
ctmp(npts-11:npts)=ctmp(npts-11:npts)*rcw(12:1:-1)
|
|
call four2a(ctmp,nfft,1,-1,1)
|
|
tonespec=abs(ctmp)**2
|
|
|
|
ismask=.false.
|
|
ismask(1901:2101)=.true. ! high tone search window
|
|
! ismask(1801:2201)=.true. ! high tone search window
|
|
iloc=maxloc(tonespec,ismask)
|
|
ihpk=iloc(1)
|
|
ah=tonespec(ihpk)
|
|
ismask=.false.
|
|
ismask(901:1101)=.true. ! window for low tone
|
|
! ismask(801:1201)=.true. ! window for low tone
|
|
iloc=maxloc(tonespec,ismask)
|
|
ilpk=iloc(1)
|
|
al=tonespec(ilpk)
|
|
fdiff=(ihpk-ilpk)*df
|
|
ferrh=(ihpk-2001)*df/2.0
|
|
ferrl=(ilpk-1001)*df/2.0
|
|
if( abs(fdiff-2000) .le. 8.0 ) then ! we are pretty sure we've got the right peaks
|
|
if( ah .ge. al ) then
|
|
ferr=ferrh
|
|
else
|
|
ferr=ferrl
|
|
endif
|
|
else
|
|
! if fdiff is not 2000, then carrier acquisition is on shaky ground
|
|
! in this case, ignore amplitude and pick the peak that has the smallest ferr
|
|
if( abs(ihpk-2001) .le. abs(ilpk-1001) ) then
|
|
ferr=ferrh
|
|
else
|
|
ferr=ferrl
|
|
endif
|
|
endif
|
|
|
|
! remove coarse freq error - should now be within a few Hz
|
|
call tweak1(cdat,npts,-(1500+ferr),cdat)
|
|
|
|
! attempt frame synchronization
|
|
! correlate with sync word waveforms - the resulting complex
|
|
! correlations provide all synch information.
|
|
cc=0
|
|
cc1=0
|
|
cc2=0
|
|
do i=1,npts-(56*6+41)
|
|
cc1(i)=sum(cdat(i:i+41)*conjg(cb))
|
|
cc2(i)=sum(cdat(i+56*6:i+56*6+41)*conjg(cb))
|
|
enddo
|
|
cc=cc1+cc2
|
|
dd=abs(cc1)*abs(cc2)
|
|
|
|
! Find 5 largest peaks
|
|
do ipk=1,5
|
|
iloc=maxloc(abs(cc))
|
|
ic1=iloc(1)
|
|
iloc=maxloc(dd)
|
|
ic2=iloc(1)
|
|
ipeaks(ipk)=ic2
|
|
dd(max(1,ic2-7):min(npts-56*6-41,ic2+7))=0.0
|
|
enddo
|
|
|
|
! See if we can find "closed brackets" - a pair of peaks that differ by 864, plus or minus
|
|
! This information is not yet used for anything
|
|
do ii=1,5
|
|
do jj=ii+1,5
|
|
if( (ii .ne. jj) .and. (abs( abs(ipeaks(ii)-ipeaks(jj))-864) .le. 5) ) then
|
|
! write(78,*) "closed brackets: ",ii,jj,ipeaks(ii),ipeaks(jj),abs(ipeaks(ii)-ipeaks(jj))
|
|
endif
|
|
enddo
|
|
enddo
|
|
|
|
do iav=0,1
|
|
do ipk=1,5
|
|
do id=1,3
|
|
if( id .eq. 1 ) is=0
|
|
if( id .eq. 2 ) is=-1
|
|
if( id .eq. 3 ) is=1
|
|
! we want ic to be the index of the first sample of the message
|
|
ic=ipeaks(ipk)
|
|
|
|
! This needs to be improved - it's used to protect the edges of the array from
|
|
! overruns.
|
|
if( ic .lt. 12 .or. ic .gt. 2*864-12 ) then
|
|
! write(*,*) "Peak not in central section: ",ipk,is,ic
|
|
cycle
|
|
endif
|
|
|
|
! bb is used to place the sampling index at the center of the eye
|
|
do i=1,6
|
|
io=i-3
|
|
bb(i) = sum( ( cdat(ic+io:ic+io+864:6) * conjg( cdat(ic+io+6:ic+io+6+864:6) ) )*2 )
|
|
enddo
|
|
iloc=maxloc(abs(bb))
|
|
ibb=iloc(1)
|
|
! write(*,*) 'ic0: ',ic,'bb peak is at : ',ibb
|
|
! Adjust frame index to place peak of bb at desired lag
|
|
ic=ic + ibb-2+is
|
|
|
|
! Sanity check - recompute bb and verify that peak is now at designated lag.
|
|
! do i=1,6
|
|
! io=i-3
|
|
! bb(i) = sum( ( cdat(ic+io:ic+io+864:6) * conjg( cdat(ic+io+6:ic+io+6+864:6) ) )*2 )
|
|
! enddo
|
|
! iloc=maxloc(abs(bb))
|
|
! ibb=iloc(1)
|
|
! write(*,*) 'ic1: ',ic,'bb peak is at : ',ibb
|
|
|
|
! Average two frames on the second pass only if its incredibly easy to do
|
|
! better than nothing. Should be improved.
|
|
c=cdat(ic:ic+864-1)
|
|
if( iav .eq. 1 ) then
|
|
id0=ic+864
|
|
id1=ic+864+863
|
|
if( id1 .le. npts ) then
|
|
c=c+cdat(id0:id1)
|
|
else
|
|
cycle
|
|
endif
|
|
endif
|
|
|
|
! Estimate fine frequency error.
|
|
cca=sum(c(1:1+41)*conjg(cb))
|
|
ccb=sum(c(1+56*6:1+56*6+41)*conjg(cb))
|
|
cfac=ccb*conjg(cca)
|
|
ferr2=atan2(imag(cfac),real(cfac))/(twopi*56*6*dt)
|
|
|
|
! Final estimate of the carrier frequency - returned to the calling program
|
|
fest=1500+ferr+ferr2
|
|
|
|
! Remove fine frequency error
|
|
call tweak1(c,NSPM,-ferr2,c)
|
|
|
|
! Estimate final frequency error and carrier phase.
|
|
cca=sum(c(1:1+41)*conjg(cb))
|
|
ccb=sum(c(1+56*6:1+56*6+41)*conjg(cb))
|
|
cfac=ccb*conjg(cca)
|
|
ffin=atan2(imag(cfac),real(cfac))/(twopi*56*6*dt)
|
|
phase0=atan2(imag(cca+ccb),real(cca+ccb))
|
|
|
|
! Remove the static phase error from the data
|
|
cfac=cmplx(cos(phase0),sin(phase0))
|
|
c=c*conjg(cfac)
|
|
|
|
! sample to get softsamples
|
|
do i=1,72
|
|
softbits(2*i-1)=imag(c(1+(i-1)*12))
|
|
softbits(2*i)=real(c(7+(i-1)*12))
|
|
enddo
|
|
hardbits=0
|
|
do i=1,144
|
|
if( softbits(i) .ge. 0.0 ) then
|
|
hardbits(i)=1
|
|
endif
|
|
enddo
|
|
|
|
! calculated the number of sync-word bits that are incorrect
|
|
! this might come in handy some day
|
|
nbadsync=sum(s8*(2*hardbits(1:8)-1))
|
|
nbadsync=nbadsync+sum(s8*(2*hardbits(57:57+7)-1))
|
|
nbadsync=16-nbadsync
|
|
|
|
! this could be used to count the number of hard errors that were corrected
|
|
hardword(1:48)=hardbits(9:9+47)
|
|
hardword(49:128)=hardbits(65:65+80-1)
|
|
unscrambledhardbits(1:127:2)=hardword(1:64)
|
|
unscrambledhardbits(2:128:2)=hardword(65:128)
|
|
|
|
! normalize the softsymbols before submitting to decoder
|
|
sav=sum(softbits)/144
|
|
s2av=sum(softbits*softbits)/144
|
|
ssig=sqrt(s2av-sav*sav)
|
|
softbits=softbits/ssig
|
|
|
|
sigma=0.65
|
|
lratio(1:48)=softbits(9:9+47)
|
|
lratio(49:128)=softbits(65:65+80-1)
|
|
lratio=exp(2.0*lratio/(sigma*sigma))
|
|
|
|
unscrambledsoftbits(1:127:2)=lratio(1:64)
|
|
unscrambledsoftbits(2:128:2)=lratio(65:128)
|
|
|
|
max_iterations=20
|
|
max_dither=50
|
|
call ldpc_decode(unscrambledsoftbits, decoded, max_iterations, niterations, max_dither, ndither)
|
|
|
|
! if( niterations .lt. 0 ) then
|
|
! msgreceived=' '
|
|
! return
|
|
! endif
|
|
if( niterations .ge. 0.0 ) then
|
|
goto 778
|
|
endif
|
|
|
|
enddo
|
|
enddo
|
|
enddo
|
|
|
|
msgreceived=' '
|
|
goto 999
|
|
|
|
778 continue
|
|
! The decoder found a codeword - compare decoded hash with calculated
|
|
! Collapse 80 decoded bits to 10 bytes. Bytes 1-9 are the message, byte 10 is the hash
|
|
do ibyte=1,10
|
|
itmp=0
|
|
do ibit=1,8
|
|
itmp=ishft(itmp,1)+iand(1,decoded((ibyte-1)*8+ibit))
|
|
enddo
|
|
i1Dec8BitBytes(ibyte)=itmp
|
|
enddo
|
|
|
|
! Calculate the hash using the first 9 bytes.
|
|
ihashdec=nhash(c_loc(i1Dec8BitBytes),int(9,c_size_t),146)
|
|
ihashdec=2*iand(ihashdec,255)
|
|
|
|
! Compare calculated hash with received byte 10 - if they agree, keep the message.
|
|
i1hashdec=ihashdec
|
|
|
|
if( i1hashdec .eq. i1Dec8BitBytes(10) ) then
|
|
! Good hash --- unpack 72-bit message
|
|
do ibyte=1,12
|
|
itmp=0
|
|
do ibit=1,6
|
|
itmp=ishft(itmp,1)+iand(1,decoded((ibyte-1)*6+ibit))
|
|
enddo
|
|
i4Dec6BitWords(ibyte)=itmp
|
|
enddo
|
|
call unpackmsg(i4Dec6BitWords,msgreceived)
|
|
else
|
|
msgreceived=' '
|
|
endif
|
|
|
|
write(78,1001) iav,ipk,is,fdiff,fest,nbadsync,phase0,niterations,ndither,i1hashdec,i1Dec8BitBytes(10),msgreceived
|
|
1001 format(i6,i6,i6,f10.1,f10.1,i6,f10.2,i6,i6,i6,i6,4x,a22)
|
|
999 return
|
|
|
|
end subroutine syncmsk144
|