1 files changed, 307 insertions, 0 deletions
diff --git a/octave/tfdmdv.m b/octave/tfdmdv.m
new file mode 100644
index 0000000..45a062a
--- /dev/null
+++ b/octave/tfdmdv.m
@@ -0,0 +1,307 @@
+% tfdmdv.m
+%
+% Octave script that tests the C port of the FDMDV modem.  This script loads
+% the output of unittest/tfdmdv.c and compares it to the output of the
+% reference versions of the same functions written in Octave.
+%
+% Usage:
+%
+%   1/ In codec2-dev/CMakeLists.txt, ensure set(CMAKE_BUILD_TYPE "Debug"), to
+%      enable building the C unittests.  Build codec2-dev as per 
+%      codec2-dev/README.
+%
+%   2/ Run the C side from the Octave directory:
+%
+%        codec2-dev/octave$ ../build_linux/unittest/tfdmdv
+%        codec2-dev/octave$ ls -l tfdmdv_out.txt
+%         -rw-rw-r-- 1 david david 3419209 Aug 27 10:05 tfdmdv_out.txt
+%
+%   3/ Run the Octave side (this script):
+%
+%        octave:1> tfdmdv
+%
+
+%
+% Copyright David Rowe 2012
+% This program is distributed under the terms of the GNU General Public License 
+% Version 2
+%
+
+more off
+format
+
+fdmdv;                 % load modem code
+autotest;              % automatic testing library
+
+
+% init fdmdv modem states and load up a few constants in this scope for convenience
+
+f = fdmdv_init;
+Nc = f.Nc;
+Nb = f.Nb;
+M  = f.M;
+Fs = f.Fs;
+P  = f.P;
+Q  = f.Q;
+
+% Generate reference vectors using Octave implementation of FDMDV modem
+
+global passes = 0;
+global fails = 0;
+frames = 35;
+prev_tx_symbols = ones(Nc+1,1); prev_tx_symbols(Nc+1) = 2;
+prev_rx_symbols = ones(Nc+1,1);
+foff_phase_rect = 1;
+channel = [];
+channel_count = 0;
+next_nin = M;
+sig_est = zeros(Nc+1,1);
+noise_est = zeros(Nc+1,1);
+
+sync = 0;
+fest_state = 0;
+fest_timer = 0;
+sync_mem = zeros(1,f.Nsync_mem);
+
+% Octave outputs we want to collect for comparison to C version
+
+tx_bits_log = [];
+tx_symbols_log = [];
+tx_baseband_log = [];
+tx_fdm_log = [];
+pilot_baseband1_log = [];
+pilot_baseband2_log = [];
+pilot_lpf1_log = [];
+pilot_lpf2_log = [];
+S1_log = [];
+S2_log = [];
+foff_coarse_log = [];
+foff_fine_log = [];
+foff_log = [];
+rx_fdm_filter_log = [];
+rx_filt_log = [];
+env_log = [];
+rx_timing_log = [];
+phase_difference_log = [];
+rx_symbols_log = [];
+rx_bits_log = []; 
+sync_bit_log = [];  
+sync_log = [];  
+nin_log = [];
+sig_est_log = [];
+noise_est_log = [];
+
+% adjust this if the screen is getting a bit cluttered
+
+global no_plot_list = [1 2 3 4 5 6 7 8 12 13 14 15 16];
+
+for fr=1:frames
+
+  % modulator
+
+  [tx_bits f] = get_test_bits(f, Nc*Nb);
+  tx_bits_log = [tx_bits_log tx_bits];
+  [tx_symbols f] = bits_to_psk(f, prev_tx_symbols, tx_bits);
+  prev_tx_symbols = tx_symbols;
+  tx_symbols_log = [tx_symbols_log tx_symbols];
+  [tx_baseband f] = tx_filter(f, tx_symbols);
+  tx_baseband_log = [tx_baseband_log tx_baseband];
+  [tx_fdm f] = fdm_upconvert(f, tx_baseband);
+  tx_fdm_log = [tx_fdm_log tx_fdm];
+
+  % channel
+
+  nin = next_nin;
+
+  % nin = M;  % when debugging good idea to uncomment this to "open loop"
+
+  channel = [channel real(tx_fdm)];
+  channel_count += M;
+  rx_fdm = channel(1:nin);
+  channel = channel(nin+1:channel_count);
+  channel_count -= nin;
+
+  % demodulator --------------------------------------------
+
+  % shift down to complex baseband
+
+  for i=1:nin
+    f.fbb_phase_rx = f.fbb_phase_rx*f.fbb_rect';
+    rx_fdm(i) = rx_fdm(i)*f.fbb_phase_rx;
+  end
+  mag = abs(f.fbb_phase_rx);
+  f.fbb_phase_rx /= mag;
+
+  % sync = 0; % when debugging good idea to uncomment this to "open loop"
+
+  [pilot prev_pilot f.pilot_lut_index f.prev_pilot_lut_index] = get_pilot(f, f.pilot_lut_index, f.prev_pilot_lut_index, nin);
+  [foff_coarse S1 S2 f] = rx_est_freq_offset(f, rx_fdm, pilot, prev_pilot, nin, !sync);
+
+  if sync == 0
+    foff = foff_coarse;
+  end
+  foff_coarse_log = [foff_coarse_log foff_coarse];
+
+  pilot_baseband1_log = [pilot_baseband1_log f.pilot_baseband1];
+  pilot_baseband2_log = [pilot_baseband2_log f.pilot_baseband2];
+  pilot_lpf1_log = [pilot_lpf1_log f.pilot_lpf1];
+  pilot_lpf2_log = [pilot_lpf2_log f.pilot_lpf2];
+  S1_log  = [S1_log S1];
+  S2_log  = [S2_log S2];
+
+  foff_rect = exp(j*2*pi*foff/Fs);
+
+  for i=1:nin
+    foff_phase_rect *= foff_rect';
+    rx_fdm_fcorr(i) = rx_fdm(i)*foff_phase_rect;
+  end
+
+  [rx_fdm_filter f] = rxdec_filter(f, rx_fdm_fcorr, nin);
+  [rx_filt f] = down_convert_and_rx_filter(f, rx_fdm_filter, nin, M/Q);
+  #{
+  for i=1:5
+    printf("[%d] rx_fdm_fcorr: %f %f rx_fdm_filter: %f %f\n", i,
+           real(rx_fdm_fcorr(i)), imag(rx_fdm_fcorr(i)), real(rx_fdm_filter(i)), imag(rx_fdm_filter(i)));
+  end
+  for i=1:5
+    printf("[%d] rx_fdm_fcorr: %f %f rxdec_lpf_mem: %f %f\n", i,
+           real(rx_fdm_fcorr(i)), imag(rx_fdm_fcorr(i)), real(f.rxdec_lpf_mem(i)), imag(f.rxdec_lpf_mem(i)));
+  end
+  #}
+  rx_filt_log = [rx_filt_log rx_filt];
+  rx_fdm_filter_log = [rx_fdm_filter_log rx_fdm_filter];
+
+  [rx_symbols rx_timing env f] = rx_est_timing(f, rx_filt, nin);
+  env_log = [env_log env];
+  rx_timing_log = [rx_timing_log rx_timing];
+  rx_symbols_log = [rx_symbols_log rx_symbols];
+
+  next_nin = M;
+  if rx_timing > 2*M/P
+     next_nin += M/P;
+  end
+  if rx_timing < 0;
+     next_nin -= M/P;
+  end
+  nin_log = [nin_log nin];
+
+  [rx_bits sync_bit foff_fine pd] = psk_to_bits(f, prev_rx_symbols, rx_symbols, 'dqpsk');
+  phase_difference_log = [phase_difference_log pd];
+
+  foff_fine_log = [foff_fine_log foff_fine];
+  foff -= 0.5*foff_fine;
+  foff_log = [foff_log foff];
+
+  [sig_est noise_est] = snr_update(f, sig_est, noise_est, pd);
+  sig_est_log = [sig_est_log sig_est];
+  noise_est_log = [noise_est_log noise_est];
+
+  prev_rx_symbols = rx_symbols;
+  rx_bits_log = [rx_bits_log rx_bits]; 
+  sync_bit_log = [sync_bit_log sync_bit];  
+
+  % freq est state machine
+
+  [sync reliable_sync_bit fest_state fest_timer sync_mem] = freq_state(f, sync_bit, fest_state, fest_timer, sync_mem);
+  sync_log = [sync_log sync];
+end
+
+% Compare to the output from the C version
+
+load tfdmdv_out.txt
+
+
+% ---------------------------------------------------------------------------------------
+% Plot output and test each C function
+% ---------------------------------------------------------------------------------------
+
+% fdmdv_get_test_bits() & bits_to_dqpsk_symbols()
+
+n = 28;
+stem_sig_and_error(1, 211, tx_bits_log_c(1:n), tx_bits_log(1:n) - tx_bits_log_c(1:n), 'tx bits', [1 n -1.5 1.5])
+stem_sig_and_error(1, 212, real(tx_symbols_log_c(1:n/2)), real(tx_symbols_log(1:n/2) - tx_symbols_log_c(1:n/2)), 'tx symbols real', [1 n/2 -1.5 1.5])
+
+% fdm_upconvert()
+
+plot_sig_and_error(3, 211, real(tx_fdm_log_c), real(tx_fdm_log - tx_fdm_log_c), 'tx fdm real')
+plot_sig_and_error(3, 212, imag(tx_fdm_log_c), imag(tx_fdm_log - tx_fdm_log_c), 'tx fdm imag')
+
+% generate_pilot_lut()
+
+plot_sig_and_error(4, 211, real(pilot_lut_c), real(f.pilot_lut - pilot_lut_c), 'pilot lut real')
+plot_sig_and_error(4, 212, imag(pilot_lut_c), imag(f.pilot_lut - pilot_lut_c), 'pilot lut imag')
+
+% rx_est_freq_offset()
+
+st=1;  en = 5*f.Npilotbaseband;
+plot_sig_and_error(5, 211, real(pilot_baseband1_log(st:en)), real(pilot_baseband1_log(st:en) - pilot_baseband1_log_c(st:en)), 'pilot baseband1 real' )
+plot_sig_and_error(5, 212, real(pilot_baseband2_log(st:en)), real(pilot_baseband2_log(st:en) - pilot_baseband2_log_c(st:en)), 'pilot baseband2 real' )
+
+st=1;  en = 5*f.Npilotlpf;
+plot_sig_and_error(6, 211, real(pilot_lpf1_log(st:en)), real(pilot_lpf1_log(st:en) - pilot_lpf1_log_c(st:en)), 'pilot lpf1 real' )
+plot_sig_and_error(6, 212, real(pilot_lpf2_log(st:en)), real(pilot_lpf2_log(st:en) - pilot_lpf2_log_c(st:en)), 'pilot lpf2 real' )
+
+plot_sig_and_error(7, 211, real(S1_log), real(S1_log - S1_log_c), 'S1 real' )
+plot_sig_and_error(7, 212, imag(S1_log), imag(S1_log - S1_log_c), 'S1 imag' )
+
+plot_sig_and_error(8, 211, real(S2_log), real(S2_log - S2_log_c), 'S2 real' )
+plot_sig_and_error(8, 212, imag(S2_log), imag(S2_log - S2_log_c), 'S2 imag' )
+
+plot_sig_and_error(9, 211, foff_coarse_log, foff_coarse_log - foff_coarse_log_c, 'Coarse Freq Offset' )
+plot_sig_and_error(9, 212, foff_fine_log, foff_fine_log - foff_fine_log_c, 'Fine Freq Offset' )
+
+plot_sig_and_error(10, 211, foff_log, foff_log - foff_log_c, 'Freq Offset' )
+plot_sig_and_error(10, 212, sync_log, sync_log - sync_log_c, 'Sync & Freq Est Coarse(0) Fine(1)', [1 frames -1.5 1.5] )
+
+plot_sig_and_error(11, 211, real(rx_fdm_filter_log), real(rx_fdm_filter_log - rx_fdm_filter_log_c), 'Rx dec filter real' )
+plot_sig_and_error(11, 212, imag(rx_fdm_filter_log), imag(rx_fdm_filter_log - rx_fdm_filter_log_c), 'Rx dec filter imag' )
+
+c=1;
+plot_sig_and_error(12, 211, real(rx_filt_log(c,:)), real(rx_filt_log(c,:) - rx_filt_log_c(c,:)), 'Rx filt real' )
+plot_sig_and_error(12, 212, imag(rx_filt_log(c,:)), imag(rx_filt_log(c,:) - rx_filt_log_c(c,:)), 'Rx filt imag' )
+
+st=1*28;
+en = 3*28;
+plot_sig_and_error(14, 211, rx_timing_log, rx_timing_log - rx_timing_log_c, 'Rx Timing' )
+stem_sig_and_error(14, 212, sync_bit_log_c, sync_bit_log - sync_bit_log_c, 'Sync bit', [1 n -1.5 1.5])
+
+stem_sig_and_error(15, 211, rx_bits_log_c(st:en), rx_bits_log(st:en) - rx_bits_log_c(st:en), 'RX bits', [1 en-st -1.5 1.5])
+stem_sig_and_error(15, 212, nin_log_c, nin_log - nin_log_c, 'nin')
+
+c = 12;
+plot_sig_and_error(16, 211, sig_est_log(c,:), sig_est_log(c,:) - sig_est_log_c(c,:), 'sig est for SNR' )
+plot_sig_and_error(16, 212, noise_est_log(c,:), noise_est_log(c,:) - noise_est_log_c(c,:), 'noise est for SNR' )
+
+fr=12;
+
+stem_sig_and_error(13, 211, real(rx_symbols_log(:,fr)), real(rx_symbols_log(:,fr) - rx_symbols_log_c(:,fr)), 'rx symbols real' )
+stem_sig_and_error(13, 212, imag(rx_symbols_log(:,fr)), imag(rx_symbols_log(:,fr) - rx_symbols_log_c(:,fr)), 'rx symbols imag' )
+
+stem_sig_and_error(17, 211, real(phase_difference_log(:,fr)), real(phase_difference_log(:,fr) - phase_difference_log_c(:,fr)), 'phase difference real' )
+stem_sig_and_error(17, 212, imag(phase_difference_log(:,fr)), imag(phase_difference_log(:,fr) - phase_difference_log_c(:,fr)), 'phase difference imag' )
+
+
+check(tx_bits_log, tx_bits_log_c, 'tx_bits');
+check(tx_symbols_log,  tx_symbols_log_c, 'tx_symbols');
+check(tx_fdm_log, tx_fdm_log_c, 'tx_fdm');
+check(f.pilot_lut, pilot_lut_c, 'pilot_lut');
+check(f.pilot_coeff, pilot_coeff_c, 'pilot_coeff');
+check(pilot_baseband1_log, pilot_baseband1_log_c, 'pilot lpf1');
+check(pilot_baseband2_log, pilot_baseband2_log_c, 'pilot lpf2');
+check(S1_log, S1_log_c, 'S1');
+check(S2_log, S2_log_c, 'S2');
+check(foff_coarse_log, foff_coarse_log_c, 'foff_coarse');
+check(foff_fine_log, foff_fine_log_c, 'foff_fine');
+check(foff_log, foff_log_c, 'foff');
+check(rx_fdm_filter_log, rx_fdm_filter_log_c, 'rxdec filter');
+check(rx_filt_log, rx_filt_log_c, 'rx filt', 2E-3);
+check(env_log, env_log_c, 'env');
+check(rx_timing_log, rx_timing_log_c, 'rx_timing');
+check(rx_symbols_log, rx_symbols_log_c, 'rx_symbols', 2E-3);
+check(rx_bits_log, rx_bits_log_c, 'rx bits');
+check(sync_bit_log, sync_bit_log_c, 'sync bit');
+check(sync_log, sync_log_c, 'sync');
+check(nin_log, nin_log_c, 'nin');
+check(sig_est_log, sig_est_log_c, 'sig_est');
+check(noise_est_log, noise_est_log_c, 'noise_est');
+printf("\npasses: %d fails: %d\n", passes, fails);