195 lines
		
	
	
		
			7.4 KiB
		
	
	
	
		
			Plaintext
		
	
	
	
	
	
		
		
			
		
	
	
			195 lines
		
	
	
		
			7.4 KiB
		
	
	
	
		
			Plaintext
		
	
	
	
	
	
| 
								 | 
							
								program msksim
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								! Simulate characteristics of a potential "MSK10" mode using LDPC (168,84)
							 | 
						||
| 
								 | 
							
								! code, OQPDK modulation, and 30 s T/R sequences.
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								! Reception and Demodulation algorithm:
							 | 
						||
| 
								 | 
							
								!   1. Compute coarse spectrum; find fc1 = approx carrier freq
							 | 
						||
| 
								 | 
							
								!   2. Mix from fc1 to 0; LPF at +/- 0.75*R
							 | 
						||
| 
								 | 
							
								!   3. Square, FFT; find peaks near -R/2 and +R/2 to get fc2
							 | 
						||
| 
								 | 
							
								!   4. Mix from fc2 to 0
							 | 
						||
| 
								 | 
							
								!   5. Fit cb13 (central part of csync) to c -> lag, phase
							 | 
						||
| 
								 | 
							
								!   6. Fit complex ploynomial for channel equalization
							 | 
						||
| 
								 | 
							
								!   7. Get soft bits from equalized data
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  parameter (KK=84)                     !Information bits (72 + CRC12)
							 | 
						||
| 
								 | 
							
								  parameter (ND=168)                    !Data symbols: LDPC (168,84), r=1/2
							 | 
						||
| 
								 | 
							
								  parameter (NS=65)                     !Sync symbols (2 x 26 + Barker 13)
							 | 
						||
| 
								 | 
							
								  parameter (NR=3)                      !Ramp up/down
							 | 
						||
| 
								 | 
							
								  parameter (NN=NR+NS+ND)               !Total symbols (236)
							 | 
						||
| 
								 | 
							
								  parameter (NSPS=1152/72)              !Samples per MSK symbol (16)
							 | 
						||
| 
								 | 
							
								  parameter (N2=2*NSPS)                 !Samples per OQPSK symbol (32)
							 | 
						||
| 
								 | 
							
								  parameter (N13=13*N2)                 !Samples in central sync vector (416)
							 | 
						||
| 
								 | 
							
								  parameter (NZ=NSPS*NN)                !Samples in baseband waveform (3776)
							 | 
						||
| 
								 | 
							
								  parameter (NFFT1=4*NSPS,NH1=NFFT1/2)
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  character*8 arg
							 | 
						||
| 
								 | 
							
								  complex cbb(0:NZ-1)                   !Complex baseband waveform
							 | 
						||
| 
								 | 
							
								  complex csync(0:NZ-1)                 !Sync symbols only, from cbb
							 | 
						||
| 
								 | 
							
								  complex cb13(0:N13-1)                 !Barker 13 waveform
							 | 
						||
| 
								 | 
							
								  complex c(0:NZ-1)                     !Complex waveform
							 | 
						||
| 
								 | 
							
								  complex c0(0:NZ-1)                    !Complex waveform
							 | 
						||
| 
								 | 
							
								  complex zz(NS+ND)                     !Complex symbol values (intermediate)
							 | 
						||
| 
								 | 
							
								  complex z
							 | 
						||
| 
								 | 
							
								  real xnoise(0:NZ-1)                   !Generated random noise
							 | 
						||
| 
								 | 
							
								  real ynoise(0:NZ-1)                   !Generated random noise
							 | 
						||
| 
								 | 
							
								  real rxdata(ND),llr(ND)               !Soft symbols
							 | 
						||
| 
								 | 
							
								  real pp(2*NSPS)                       !Shaped pulse for OQPSK
							 | 
						||
| 
								 | 
							
								  real a(5)                             !For twkfreq1
							 | 
						||
| 
								 | 
							
								  real aa(20),bb(20)                    !Fitted polyco's
							 | 
						||
| 
								 | 
							
								  integer id(NS+ND)                     !NRZ values (+/-1) for Sync and Data
							 | 
						||
| 
								 | 
							
								  integer ierror(NS+ND)
							 | 
						||
| 
								 | 
							
								  integer icw(NN)
							 | 
						||
| 
								 | 
							
								  integer*1 msgbits(KK),decoded(KK),apmask(ND),cw(ND)
							 | 
						||
| 
								 | 
							
								!  integer*1 codeword(ND)
							 | 
						||
| 
								 | 
							
								  data msgbits/0,0,1,0,0,1,1,1,1,0,0,1,0,0,0,0,0,0,0,0,1,0,0,0,1,1,0,0,0,1, &
							 | 
						||
| 
								 | 
							
								       1,1,1,0,1,1,1,1,1,1,1,0,0,1,0,0,1,1,0,1,0,1,1,1,0,1,1,0,1,1,         &
							 | 
						||
| 
								 | 
							
								       1,1,0,1,0,1,1,0,0,0,0,0,1,0,0,0,0,0,1,0,1,0,1,0/
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  nargs=iargc()
							 | 
						||
| 
								 | 
							
								  if(nargs.ne.6) then
							 | 
						||
| 
								 | 
							
								     print*,'Usage:   mskhfsim f0(Hz) delay(ms) fspread(Hz) maxn iters snr(dB)'
							 | 
						||
| 
								 | 
							
								     print*,'Example: mskhfsim 0 0 0 5 10 -20'
							 | 
						||
| 
								 | 
							
								     print*,'Set snr=0 to cycle through a range'
							 | 
						||
| 
								 | 
							
								     go to 999
							 | 
						||
| 
								 | 
							
								  endif
							 | 
						||
| 
								 | 
							
								  call getarg(1,arg)
							 | 
						||
| 
								 | 
							
								  read(arg,*) f0                         !Generated carrier frequency
							 | 
						||
| 
								 | 
							
								  call getarg(2,arg)
							 | 
						||
| 
								 | 
							
								  read(arg,*) delay                      !Delta_t (ms) for Watterson model
							 | 
						||
| 
								 | 
							
								  call getarg(3,arg)
							 | 
						||
| 
								 | 
							
								  read(arg,*) fspread                    !Fspread (Hz) for Watterson model
							 | 
						||
| 
								 | 
							
								  call getarg(4,arg)
							 | 
						||
| 
								 | 
							
								  read(arg,*) maxn                       !Max nterms for polyfit
							 | 
						||
| 
								 | 
							
								  call getarg(5,arg)
							 | 
						||
| 
								 | 
							
								  read(arg,*) iters                      !Iterations at each SNR
							 | 
						||
| 
								 | 
							
								  call getarg(6,arg)
							 | 
						||
| 
								 | 
							
								  read(arg,*) snrdb                      !Specified SNR_2500
							 | 
						||
| 
								 | 
							
								  
							 | 
						||
| 
								 | 
							
								  twopi=8.0*atan(1.0)
							 | 
						||
| 
								 | 
							
								  fs=12000.0/72.0                        !Sample rate = 166.6666667 Hz
							 | 
						||
| 
								 | 
							
								  dt=1.0/fs                              !Sample interval (s)
							 | 
						||
| 
								 | 
							
								  tt=NSPS*dt                             !Duration of "itone" symbols (s)
							 | 
						||
| 
								 | 
							
								  ts=2*NSPS*dt                           !Duration of OQPSK symbols (s)
							 | 
						||
| 
								 | 
							
								  baud=1.0/tt                            !Keying rate for "itone" symbols (baud)
							 | 
						||
| 
								 | 
							
								  txt=NZ*dt                              !Transmission length (s)
							 | 
						||
| 
								 | 
							
								  bandwidth_ratio=2500.0/(fs/2.0)
							 | 
						||
| 
								 | 
							
								  write(*,1000) f0,delay,fspread,maxn,iters,baud,3*baud,txt
							 | 
						||
| 
								 | 
							
								1000 format('f0:',f5.1,'  Delay:',f4.1,'  fSpread:',f5.2,'  maxn:',i3,   &
							 | 
						||
| 
								 | 
							
								          '  Iters:',i6/'Baud:',f7.3,'  BW:',f5.1,'  TxT:',f5.1,f5.2/)
							 | 
						||
| 
								 | 
							
								  write(*,1004)
							 | 
						||
| 
								 | 
							
								1004 format(/'  SNR     err    ber    fer   fsigma'/37('-'))
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  do i=1,N2                              !Half-sine pulse shape
							 | 
						||
| 
								 | 
							
								     pp(i)=sin(0.5*(i-1)*twopi/(2*NSPS))
							 | 
						||
| 
								 | 
							
								  enddo
							 | 
						||
| 
								 | 
							
								  
							 | 
						||
| 
								 | 
							
								  call genmskhf(msgbits,id,icw,cbb,csync)!Generate baseband waveform and csync
							 | 
						||
| 
								 | 
							
								  cb13=csync(1680:2095)                  !Copy the Barker 13 waveform
							 | 
						||
| 
								 | 
							
								  a=0.
							 | 
						||
| 
								 | 
							
								  a(1)=f0
							 | 
						||
| 
								 | 
							
								  call twkfreq1(cbb,NZ,fs,a,cbb)         !Mix to specified frequency
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								  isna=-10
							 | 
						||
| 
								 | 
							
								  isnb=-30
							 | 
						||
| 
								 | 
							
								  if(snrdb.ne.0.0) then
							 | 
						||
| 
								 | 
							
								     isna=nint(snrdb)
							 | 
						||
| 
								 | 
							
								     isnb=isna
							 | 
						||
| 
								 | 
							
								  endif
							 | 
						||
| 
								 | 
							
								  do isnr=isna,isnb,-1                   !Loop over SNR range
							 | 
						||
| 
								 | 
							
								     snrdb=isnr
							 | 
						||
| 
								 | 
							
								     sig=sqrt(bandwidth_ratio) * 10.0**(0.05*snrdb)
							 | 
						||
| 
								 | 
							
								     if(snrdb.gt.90.0) sig=1.0
							 | 
						||
| 
								 | 
							
								     nhard=0
							 | 
						||
| 
								 | 
							
								     nhardsync=0
							 | 
						||
| 
								 | 
							
								     nfe=0
							 | 
						||
| 
								 | 
							
								     sqf=0.
							 | 
						||
| 
								 | 
							
								     do iter=1,iters                     !Loop over requested iterations
							 | 
						||
| 
								 | 
							
								        c=cbb
							 | 
						||
| 
								 | 
							
								        if(delay.ne.0.0 .or. fspread.ne.0.0) then
							 | 
						||
| 
								 | 
							
								           call watterson(c,NZ,fs,delay,fspread)
							 | 
						||
| 
								 | 
							
								        endif
							 | 
						||
| 
								 | 
							
								        c=sig*c                          !Scale to requested SNR
							 | 
						||
| 
								 | 
							
								        if(snrdb.lt.90) then
							 | 
						||
| 
								 | 
							
								           do i=0,NZ-1                   !Generate gaussian noise
							 | 
						||
| 
								 | 
							
								              xnoise(i)=gran()
							 | 
						||
| 
								 | 
							
								              ynoise(i)=gran()
							 | 
						||
| 
								 | 
							
								           enddo
							 | 
						||
| 
								 | 
							
								           c=c + cmplx(xnoise,ynoise)    !Add AWGN noise
							 | 
						||
| 
								 | 
							
								        endif
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								        call getfc1(c,fc1)               !First approx for freq
							 | 
						||
| 
								 | 
							
								        call getfc2(c,csync,fc1,fc2,fc3) !Refined freq
							 | 
						||
| 
								 | 
							
								        sqf=sqf + (fc1+fc2-f0)**2
							 | 
						||
| 
								 | 
							
								        
							 | 
						||
| 
								 | 
							
								!NB: Measured performance is about equally good using fc2 or fc3 here:
							 | 
						||
| 
								 | 
							
								        a(1)=-(fc1+fc2)
							 | 
						||
| 
								 | 
							
								        a(2:5)=0.
							 | 
						||
| 
								 | 
							
								        call twkfreq1(c,NZ,fs,a,c)       !Mix c down by fc1+fc2
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								! The following may not be necessary?
							 | 
						||
| 
								 | 
							
								!        z=sum(c(1680:2095)*cb13)/208.0     !Get phase from Barker 13 vector
							 | 
						||
| 
								 | 
							
								!        z0=z/abs(z)
							 | 
						||
| 
								 | 
							
								!        c=c*conjg(z0)
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								!---------------------------------------------------------------- DT
							 | 
						||
| 
								 | 
							
								! Not presently used:
							 | 
						||
| 
								 | 
							
								        amax=0.
							 | 
						||
| 
								 | 
							
								        jpk=0
							 | 
						||
| 
								 | 
							
								        do j=-20*NSPS,20*NSPS            !Get jpk
							 | 
						||
| 
								 | 
							
								           z=sum(c(1680+j:2095+j)*cb13)/208.0
							 | 
						||
| 
								 | 
							
								           if(abs(z).gt.amax) then
							 | 
						||
| 
								 | 
							
								              amax=abs(z)
							 | 
						||
| 
								 | 
							
								              jpk=j
							 | 
						||
| 
								 | 
							
								           endif
							 | 
						||
| 
								 | 
							
								        enddo
							 | 
						||
| 
								 | 
							
								        xdt=jpk/fs
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								        nterms=maxn
							 | 
						||
| 
								 | 
							
								        c0=c
							 | 
						||
| 
								 | 
							
								        do itry=1,10
							 | 
						||
| 
								 | 
							
								           idf=itry/2
							 | 
						||
| 
								 | 
							
								           if(mod(itry,2).eq.0) idf=-idf
							 | 
						||
| 
								 | 
							
								           nhard0=0
							 | 
						||
| 
								 | 
							
								           nhardsync0=0
							 | 
						||
| 
								 | 
							
								           ifer=1
							 | 
						||
| 
								 | 
							
								           a(1)=idf*0.01
							 | 
						||
| 
								 | 
							
								           a(2:5)=0.
							 | 
						||
| 
								 | 
							
								           call twkfreq1(c0,NZ,fs,a,c)       !Mix c0 into c
							 | 
						||
| 
								 | 
							
								           call cpolyfit(c,pp,id,maxn,aa,bb,zz,nhs)
							 | 
						||
| 
								 | 
							
								           call msksoftsym(zz,aa,bb,id,nterms,ierror,rxdata,nhard0,nhardsync0)
							 | 
						||
| 
								 | 
							
								           if(nhardsync0.gt.12) cycle
							 | 
						||
| 
								 | 
							
								           rxav=sum(rxdata)/ND
							 | 
						||
| 
								 | 
							
								           rx2av=sum(rxdata*rxdata)/ND
							 | 
						||
| 
								 | 
							
								           rxsig=sqrt(rx2av-rxav*rxav)
							 | 
						||
| 
								 | 
							
								           rxdata=rxdata/rxsig
							 | 
						||
| 
								 | 
							
								           ss=0.84
							 | 
						||
| 
								 | 
							
								           llr=2.0*rxdata/(ss*ss)
							 | 
						||
| 
								 | 
							
								           apmask=0
							 | 
						||
| 
								 | 
							
								           max_iterations=40
							 | 
						||
| 
								 | 
							
								           ifer=0
							 | 
						||
| 
								 | 
							
								           call bpdecode168(llr,apmask,max_iterations,decoded,niterations,cw)
							 | 
						||
| 
								 | 
							
								           nbadcrc=0
							 | 
						||
| 
								 | 
							
								           if(niterations.ge.0) call chkcrc12(decoded,nbadcrc)
							 | 
						||
| 
								 | 
							
								           if(niterations.lt.0 .or. count(msgbits.ne.decoded).gt.0 .or.        &
							 | 
						||
| 
								 | 
							
								                nbadcrc.ne.0) ifer=1
							 | 
						||
| 
								 | 
							
								!           if(ifer.eq.0) write(67,1301) snrdb,itry,idf,niterations,    &
							 | 
						||
| 
								 | 
							
								!                nhardsync0,nhard0
							 | 
						||
| 
								 | 
							
								!1301       format(f6.1,5i6)
							 | 
						||
| 
								 | 
							
								           if(ifer.eq.0) exit
							 | 
						||
| 
								 | 
							
								        enddo                                !Freq dither loop
							 | 
						||
| 
								 | 
							
								        nhard=nhard+nhard0
							 | 
						||
| 
								 | 
							
								        nhardsync=nharsdync+nhardsync0
							 | 
						||
| 
								 | 
							
								        nfe=nfe+ifer
							 | 
						||
| 
								 | 
							
								     enddo
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								     fsigma=sqrt(sqf/iters)
							 | 
						||
| 
								 | 
							
								     ber=float(nhard)/((NS+ND)*iters)
							 | 
						||
| 
								 | 
							
								     fer=float(nfe)/iters
							 | 
						||
| 
								 | 
							
								     write(*,1050)  snrdb,nhard,ber,fer,fsigma
							 | 
						||
| 
								 | 
							
								!     write(60,1050)  snrdb,nhard,ber,fer,fsigma
							 | 
						||
| 
								 | 
							
								1050 format(f6.1,i7,f8.4,f7.3,f8.2)
							 | 
						||
| 
								 | 
							
								  enddo
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								999 end program msksim
							 |