mirror of
https://github.com/saitohirga/WSJT-X.git
synced 2024-11-05 00:41:19 -05:00
dd1362b69a
Generic message packing and unpacking routines now understand antipode grid contest messages. These messages are now recognized as standard messages in message response processing and dealt with appropriately when contest mode is selected and applicable (currently FT8 and MSK144 only). git-svn-id: svn+ssh://svn.code.sf.net/p/wsjt/wsjt/branches/wsjtx@8062 ab8295b8-cf94-4d9e-aec4-7959e3be5d79
305 lines
7.9 KiB
Fortran
305 lines
7.9 KiB
Fortran
subroutine syncmsk(cdat,npts,jpk,ipk,idf,rmax,snr,metric,decoded)
|
|
|
|
! Attempt synchronization, and if successful decode using Viterbi algorithm.
|
|
|
|
use iso_c_binding, only: c_loc,c_size_t
|
|
use packjt
|
|
use hashing
|
|
use timer_module, only: timer
|
|
|
|
parameter (NSPM=1404,NSAVE=2000)
|
|
complex cdat(npts) !Analytic signal
|
|
complex cb(66) !Complex waveform for Barker-11 code
|
|
complex cd(0:11,0:3)
|
|
complex c(0:NSPM-1) !Complex data for one message length
|
|
complex c2(0:NSPM-1)
|
|
complex cb3(1:NSPM,3)
|
|
real r(12000)
|
|
real rdat(12000)
|
|
real ss1(12000)
|
|
real symbol(234)
|
|
real rdata(198)
|
|
real rd2(198)
|
|
real rsave(NSAVE)
|
|
real xp(29)
|
|
complex z,z0,z1,z2,z3,cfac
|
|
integer*1 e1(198)
|
|
integer*1, target :: d8(13)
|
|
integer*1 i1hash(4)
|
|
integer*1 i1
|
|
integer*4 i4Msg6BitWords(12) !72-bit message as 6-bit words
|
|
integer mettab(0:255,0:1) !Metric table for BPSK modulation
|
|
integer ipksave(NSAVE)
|
|
integer jpksave(NSAVE)
|
|
integer indx(NSAVE)
|
|
integer b11(11) !Barker-11 code
|
|
character*22 decoded
|
|
character*72 c72
|
|
logical first
|
|
equivalence (i1,i4)
|
|
equivalence (ihash,i1hash)
|
|
data xp/0.500000, 0.401241, 0.309897, 0.231832, 0.168095, &
|
|
0.119704, 0.083523, 0.057387, 0.039215, 0.026890, &
|
|
0.018084, 0.012184, 0.008196, 0.005475, 0.003808, &
|
|
0.002481, 0.001710, 0.001052, 0.000789, 0.000469, &
|
|
0.000329, 0.000225, 0.000187, 0.000086, 0.000063, &
|
|
0.000017, 0.000091, 0.000032, 0.000045/
|
|
data first/.true./
|
|
data b11/1,1,1,0,0,0,1,0,0,1,0/
|
|
save first,cb,cd,twopi,dt,f0,f1,mettab
|
|
|
|
phi=0.
|
|
if(first) then
|
|
! Get the metric table
|
|
bias=0.0
|
|
scale=20.0
|
|
xln2=log(2.0)
|
|
mettab=0
|
|
do i=128,156
|
|
x0=log(max(0.001,2.0*xp(i-127)))/xln2
|
|
x1=log(max(0.001,2.0*(1.0-xp(i-127))))/xln2
|
|
mettab(i,0)=nint(scale*(x0-bias))
|
|
mettab(i,1)=nint(scale*(x1-bias))
|
|
mettab(256-i,0)=mettab(i,1)
|
|
mettab(256-i,1)=mettab(i,0)
|
|
enddo
|
|
do i=157,255
|
|
mettab(i,0)=mettab(156,0)
|
|
mettab(i,1)=mettab(156,1)
|
|
mettab(256-i,0)=mettab(i,1)
|
|
mettab(256-i,1)=mettab(i,0)
|
|
enddo
|
|
j=0
|
|
twopi=8.0*atan(1.0)
|
|
dt=1.0/12000.0
|
|
f0=1000.0
|
|
f1=2000.0
|
|
dphi=0
|
|
do i=1,11
|
|
if(b11(i).eq.0) dphi=twopi*f0*dt
|
|
if(b11(i).eq.1) dphi=twopi*f1*dt
|
|
do n=1,6
|
|
j=j+1
|
|
phi=phi+dphi
|
|
cb(j)=cmplx(cos(phi),sin(phi))
|
|
enddo
|
|
enddo
|
|
cb3=0.
|
|
cb3(1:66,1)=cb
|
|
cb3(283:348,1)=cb
|
|
cb3(769:834,1)=cb
|
|
|
|
cb3(1:66,2)=cb
|
|
cb3(487:552,2)=cb
|
|
cb3(1123:1188,2)=cb
|
|
|
|
cb3(1:66,3)=cb
|
|
cb3(637:702,3)=cb
|
|
cb3(919:984,3)=cb
|
|
|
|
phi=0.
|
|
do n=0,3
|
|
k=-1
|
|
dphi=twopi*f0*dt
|
|
if(n.ge.2) dphi=twopi*f1*dt
|
|
do i=0,5
|
|
k=k+1
|
|
phi=phi+dphi
|
|
if(phi.gt.twopi) phi=phi-twopi
|
|
cd(k,n)=cmplx(cos(phi),sin(phi))
|
|
enddo
|
|
|
|
dphi=twopi*f0*dt
|
|
if(mod(n,2).eq.1) dphi=twopi*f1*dt
|
|
do i=6,11
|
|
k=k+1
|
|
phi=phi+dphi
|
|
if(phi.gt.twopi) phi=phi-twopi
|
|
cd(k,n)=cmplx(cos(phi),sin(phi))
|
|
enddo
|
|
enddo
|
|
|
|
first=.false.
|
|
endif
|
|
|
|
nfft=NSPM
|
|
jz=npts-nfft
|
|
decoded=" "
|
|
ipk=0
|
|
jpk=0
|
|
metric=-9999
|
|
r=0.
|
|
|
|
call timer('sync1 ',0)
|
|
do j=1,jz !Find the Barker-11 sync vectors
|
|
z=0.
|
|
ss=0.
|
|
do i=1,66
|
|
ss=ss + real(cdat(j+i-1))**2 + aimag(cdat(j+i-1))**2
|
|
z=z + cdat(j+i-1)*conjg(cb(i)) !Signal matching Barker 11
|
|
enddo
|
|
ss=sqrt(ss/66.0)*66.0
|
|
r(j)=abs(z)/(0.908*ss) !Goodness-of-fit to Barker 11
|
|
ss1(j)=ss
|
|
enddo
|
|
call timer('sync1 ',1)
|
|
|
|
call timer('sync2 ',0)
|
|
jz=npts-nfft
|
|
rmax=0.
|
|
! n1=35, n2=69, n3=94
|
|
k=0
|
|
do j=1,jz !Find best full-message sync
|
|
if(ss1(j).lt.85.0) cycle
|
|
r1=r(j) + r(j+282) + r(j+768) ! 6*(12+n1) 6*(24+n1+n2)
|
|
r2=r(j) + r(j+486) + r(j+1122) ! 6*(12+n2) 6*(24+n2+n3)
|
|
r3=r(j) + r(j+636) + r(j+918) ! 6*(12+n3) 6*(24+n3+n1)
|
|
if(r1.gt.rmax) then
|
|
rmax=r1
|
|
jpk=j
|
|
ipk=1
|
|
endif
|
|
if(r2.gt.rmax) then
|
|
rmax=r2
|
|
jpk=j
|
|
ipk=2
|
|
endif
|
|
if(r3.gt.rmax) then
|
|
rmax=r3
|
|
jpk=j
|
|
ipk=3
|
|
endif
|
|
rrmax=max(r1,r2,r3)
|
|
if(rrmax.gt.1.9) then
|
|
k=min(k+1,NSAVE)
|
|
if(r1.eq.rrmax) ipksave(k)=1
|
|
if(r2.eq.rrmax) ipksave(k)=2
|
|
if(r3.eq.rrmax) ipksave(k)=3
|
|
jpksave(k)=j
|
|
rsave(k)=rrmax
|
|
endif
|
|
enddo
|
|
call timer('sync2 ',1)
|
|
kmax=k
|
|
|
|
call indexx(rsave,kmax,indx)
|
|
|
|
call timer('sync3 ',0)
|
|
do kk=1,kmax
|
|
k=indx(kmax+1-kk)
|
|
ipk=ipksave(k)
|
|
jpk=jpksave(k)
|
|
rmax=rsave(k)
|
|
|
|
c=conjg(cb3(1:NSPM,ipk))*cdat(jpk:jpk+nfft-1)
|
|
smax=0.
|
|
dfx=0.
|
|
idfbest=0
|
|
do itry=1,25
|
|
idf=itry/2
|
|
if(mod(itry,2).eq.0) idf=-idf
|
|
idf=4*idf
|
|
twk=idf
|
|
call tweak1(c,NSPM,-twk,c2)
|
|
z=sum(c2)
|
|
if(abs(z).gt.smax) then
|
|
dfx=twk
|
|
smax=abs(z)
|
|
phi=atan2(aimag(z),real(z)) !Carrier phase offset
|
|
idfbest=idf
|
|
endif
|
|
enddo
|
|
idf=idfbest
|
|
call tweak1(cdat,npts,-dfx,cdat)
|
|
cfac=cmplx(cos(phi),-sin(phi))
|
|
cdat=cfac*cdat
|
|
|
|
sig=0.
|
|
ref=0.
|
|
rdat(1:npts)=cdat
|
|
iz=11
|
|
do k=1,234 !Compute soft symbols
|
|
j=jpk+6*(k-1)
|
|
|
|
z0=2.0*dot_product(cdat(j:j+iz),cd(0:iz,0))
|
|
z1=2.0*dot_product(cdat(j:j+iz),cd(0:iz,1))
|
|
z2=2.0*dot_product(cdat(j:j+iz),cd(0:iz,2))
|
|
z3=2.0*dot_product(cdat(j:j+iz),cd(0:iz,3))
|
|
|
|
!### Maybe these should be weighted by yellow() ?
|
|
if(j+1404+iz.lt.npts) then
|
|
z0=z0 + dot_product(cdat(j+1404:j+1404+iz),cd(0:iz,0))
|
|
z1=z1 + dot_product(cdat(j+1404:j+1404+iz),cd(0:iz,1))
|
|
z2=z2 + dot_product(cdat(j+1404:j+1404+iz),cd(0:iz,2))
|
|
z3=z3 + dot_product(cdat(j+1404:j+1404+iz),cd(0:iz,3))
|
|
endif
|
|
|
|
if(j-1404.ge.1) then
|
|
z0=z0 + dot_product(cdat(j-1404:j-1404+iz),cd(0:iz,0))
|
|
z1=z1 + dot_product(cdat(j-1404:j-1404+iz),cd(0:iz,1))
|
|
z2=z2 + dot_product(cdat(j-1404:j-1404+iz),cd(0:iz,2))
|
|
z3=z3 + dot_product(cdat(j-1404:j-1404+iz),cd(0:iz,3))
|
|
endif
|
|
|
|
sym=max(abs(real(z2)),abs(real(z3))) - max(abs(real(z0)),abs(real(z1)))
|
|
|
|
if(sym.lt.0.0) then
|
|
phi=atan2(aimag(z0),real(z0))
|
|
sig=sig + real(z0)**2
|
|
ref=ref + aimag(z0)**2
|
|
else
|
|
phi=atan2(aimag(z1),real(z1))
|
|
sig=sig + real(z1)**2
|
|
ref=ref + aimag(z1)**2
|
|
endif
|
|
n=k
|
|
if(ipk.eq.2) n=k+47
|
|
if(ipk.eq.3) n=k+128
|
|
if(n.gt.234) n=n-234
|
|
ibit=0
|
|
if(sym.ge.0) ibit=1
|
|
symbol(n)=sym
|
|
enddo
|
|
snr=db(sig/ref-1.0)
|
|
|
|
rdata(1:35)=symbol(12:46)
|
|
rdata(36:104)=symbol(59:127)
|
|
rdata(105:198)=symbol(140:233)
|
|
|
|
! Re-order the symbols and make them i*1
|
|
j=0
|
|
do i=1,99
|
|
i4=128+rdata(i) !### Should be nint() ??? ###
|
|
if(i4.gt.255) i4=255
|
|
if(i4.lt.0) i4=0
|
|
j=j+1
|
|
e1(j)=i1
|
|
rd2(j)=rdata(i)
|
|
i4=128+rdata(i+99)
|
|
if(i4.gt.255) i4=255
|
|
if(i4.lt.0) i4=0
|
|
j=j+1
|
|
e1(j)=i1
|
|
rd2(j)=rdata(i+99)
|
|
enddo
|
|
|
|
! Decode the message
|
|
nb1=87
|
|
call vit213(e1,nb1,mettab,d8,metric)
|
|
ihash=nhash(c_loc(d8),int(9,c_size_t),146)
|
|
ihash=2*iand(ihash,32767)
|
|
decoded=' '
|
|
if(d8(10).eq.i1hash(2) .and. d8(11).eq.i1hash(1)) then
|
|
write(c72,1012) d8(1:9)
|
|
1012 format(9b8.8)
|
|
read(c72,1014) i4Msg6BitWords
|
|
1014 format(12b6.6)
|
|
call unpackmsg(i4Msg6BitWords,decoded,.false.,' ') !Unpack to get msgsent
|
|
endif
|
|
if(decoded.ne.' ') exit
|
|
enddo
|
|
call timer('sync3 ',1)
|
|
|
|
return
|
|
end subroutine syncmsk
|