From: drowe67 <drowe67@01035d8c-6547-0410-b346-abe4f91aad63>
Date: Mon, 21 Jul 2014 10:50:21 +0000 (+0000)
Subject: fdmdv stm32f4 UT working.  mod fast enough but demod too slow, have traced to filtering.
X-Git-Url: http://git.whiteaudio.com/gitweb/?a=commitdiff_plain;h=61d231d2bc04e5e0d7b5284d8a75af4bdedc97d2;p=freetel-svn-tracking.git

fdmdv stm32f4 UT working.  mod fast enough but demod too slow, have traced to filtering.

git-svn-id: https://svn.code.sf.net/p/freetel/code@1767 01035d8c-6547-0410-b346-abe4f91aad63
---

diff --git a/codec2-dev/src/fdmdv.c b/codec2-dev/src/fdmdv.c
index 0498aea0..cd117d77 100644
--- a/codec2-dev/src/fdmdv.c
+++ b/codec2-dev/src/fdmdv.c
@@ -45,10 +45,15 @@
 #include "kiss_fft.h"
 #include "hanning.h"
 #include "os.h"
+#include "machdep.h"
 
 static int sync_uw[] = {1,-1,1,-1,1,-1};
 
-/*---------------------------------------------------------------------------* \
+#ifdef __EMBEDDED__
+#define printf gdb_stdio_printf
+#endif
+
+/*---------------------------------------------------------------------------*\
                                                                              
                                FUNCTIONS
 
@@ -521,11 +526,16 @@ void fdmdv_mod(struct FDMDV *fdmdv, COMP tx_fdm[], int tx_bits[], int *sync_bit)
 {
     COMP          tx_symbols[NC+1];
     COMP          tx_baseband[NC+1][M];
+    TIMER_VAR(mod_start, tx_filter_start, fdm_upconvert_start);
 
+    TIMER_SAMPLE(mod_start);
     bits_to_dqpsk_symbols(tx_symbols, fdmdv->Nc, fdmdv->prev_tx_symbols, tx_bits, &fdmdv->tx_pilot_bit, fdmdv->old_qpsk_mapping);
     memcpy(fdmdv->prev_tx_symbols, tx_symbols, sizeof(COMP)*(fdmdv->Nc+1));
+    TIMER_SAMPLE_AND_LOG(tx_filter_start, mod_start, "    bits_to_dqpsk_symbols"); 
     tx_filter(tx_baseband, fdmdv->Nc, tx_symbols, fdmdv->tx_filter_memory);
+    TIMER_SAMPLE_AND_LOG(fdm_upconvert_start, tx_filter_start, "    tx_filter"); 
     fdm_upconvert(tx_fdm, fdmdv->Nc, tx_baseband, fdmdv->phase_tx, fdmdv->freq);
+    TIMER_SAMPLE_AND_LOG2(fdm_upconvert_start, "    fdm_upconvert"); 
 
     *sync_bit = fdmdv->tx_pilot_bit;
 }
@@ -910,6 +920,7 @@ void down_convert_and_rx_filter(COMP rx_filt[NC+1][P+1], int Nc, COMP rx_fdm[],
     float windback_phase, mag;
     COMP  windback_phase_rect;
     COMP  rx_baseband[NFILTER+M];
+    TIMER_VAR(windback_start,  downconvert_start, filter_start);
 
     /* update memory of rx_fdm */
 
@@ -933,10 +944,12 @@ void down_convert_and_rx_filter(COMP rx_filt[NC+1][P+1], int Nc, COMP rx_fdm[],
           phase continuity.
         */
 
+        TIMER_SAMPLE(windback_start);
         windback_phase           = -freq_pol[c]*NFILTER;
         windback_phase_rect.real = cosf(windback_phase);
         windback_phase_rect.imag = sinf(windback_phase);
         phase_rx[c]              = cmult(phase_rx[c],windback_phase_rect);
+        TIMER_SAMPLE_AND_LOG(downconvert_start, windback_start, "        windback"); 
     
         /* down convert all samples in buffer */
 
@@ -948,6 +961,7 @@ void down_convert_and_rx_filter(COMP rx_filt[NC+1][P+1], int Nc, COMP rx_fdm[],
             phase_rx[c]    = cmult(phase_rx[c], freq[c]);
             rx_baseband[i] = cmult(rx_fdm_mem[i],cconj(phase_rx[c]));
         }
+        TIMER_SAMPLE_AND_LOG(filter_start, downconvert_start, "        downconvert"); 
  
         /* now we can filter this carrier's P symbols */
 
@@ -959,6 +973,7 @@ void down_convert_and_rx_filter(COMP rx_filt[NC+1][P+1], int Nc, COMP rx_fdm[],
             for(m=0; m<NFILTER; m++) 
                 rx_filt[c][k] = cadd(rx_filt[c][k], fcmult(gt_alpha5_root[m], rx_baseband[st+i+m]));
         }
+        TIMER_SAMPLE_AND_LOG2(filter_start, "        filter"); 
 
         /* normalise digital oscilators as the magnitude can drift over time */
 
@@ -1370,20 +1385,27 @@ void fdmdv_demod(struct FDMDV *fdmdv, int rx_bits[],
     COMP          rx_symbols[NC+1];
     float         env[NT*P];
     int           sync_bit;
+    TIMER_VAR(demod_start, fdmdv_freq_shift_start, down_convert_and_rx_filter_start);
+    TIMER_VAR(rx_est_timing_start, qpsk_to_bits_start, snr_update_start, freq_state_start);
 
     /* freq offset estimation and correction */
    
+    TIMER_SAMPLE(demod_start);
     foff_coarse = rx_est_freq_offset(fdmdv, rx_fdm, *nin);
+    TIMER_SAMPLE_AND_LOG(fdmdv_freq_shift_start, demod_start, "    rx_est_freq_offset"); 
     
     if (fdmdv->sync == 0)
 	fdmdv->foff = foff_coarse;
     fdmdv_freq_shift(rx_fdm_fcorr, rx_fdm, -fdmdv->foff, &fdmdv->foff_phase_rect, *nin);
-	
+    TIMER_SAMPLE_AND_LOG(down_convert_and_rx_filter_start, fdmdv_freq_shift_start, "    fdmdv_freq_shift"); 
+ 	
     /* baseband processing */
 
     down_convert_and_rx_filter(rx_filt, fdmdv->Nc, rx_fdm_fcorr, fdmdv->rx_fdm_mem, fdmdv->phase_rx, fdmdv->freq, 
                                fdmdv->freq_pol, *nin);
+    TIMER_SAMPLE_AND_LOG(rx_est_timing_start, down_convert_and_rx_filter_start, "    down_convert_and_rx_filter"); 
     fdmdv->rx_timing = rx_est_timing(rx_symbols, fdmdv->Nc, rx_filt, fdmdv->rx_filter_mem_timing, env, *nin);	 
+    TIMER_SAMPLE_AND_LOG(qpsk_to_bits_start, rx_est_timing_start, "    rx_est_timing"); 
     
     /* Adjust number of input samples to keep timing within bounds */
 
@@ -1398,11 +1420,14 @@ void fdmdv_demod(struct FDMDV *fdmdv, int rx_bits[],
     foff_fine = qpsk_to_bits(rx_bits, &sync_bit, fdmdv->Nc, fdmdv->phase_difference, fdmdv->prev_rx_symbols, rx_symbols, 
                              fdmdv->old_qpsk_mapping);
     memcpy(fdmdv->prev_rx_symbols, rx_symbols, sizeof(COMP)*(fdmdv->Nc+1));
+    TIMER_SAMPLE_AND_LOG(snr_update_start, qpsk_to_bits_start, "    qpsk_to_bits"); 
     snr_update(fdmdv->sig_est, fdmdv->noise_est, fdmdv->Nc, fdmdv->phase_difference);
+    TIMER_SAMPLE_AND_LOG(freq_state_start, snr_update_start, "    snr_update"); 
 
     /* freq offset estimation state machine */
 
     fdmdv->sync = freq_state(reliable_sync_bit, sync_bit, &fdmdv->fest_state, &fdmdv->timer, fdmdv->sync_mem);
+    TIMER_SAMPLE_AND_LOG2(freq_state_start, "    freq_state"); 
     fdmdv->foff  -= TRACK_COEFF*foff_fine;
 }
 
@@ -1425,8 +1450,8 @@ float calc_snr(int Nc, float sig_est[], float noise_est[])
    
     S = 0.0;
     for(c=0; c<Nc+1; c++)
-	S += pow(sig_est[c], 2.0);
-    SdB = 10.0*log10(S+1E-12);
+	S += powf(sig_est[c], 2.0);
+    SdB = 10.0*log10f(S+1E-12);
     
     /* Average noise mag across all carriers and square to get an
        average noise power.  This is an estimate of the noise power in
@@ -1437,13 +1462,13 @@ float calc_snr(int Nc, float sig_est[], float noise_est[])
     for(c=0; c<Nc+1; c++)
 	mean += noise_est[c];
     mean /= (Nc+1);
-    N50 = pow(mean, 2.0);
-    N50dB = 10.0*log10(N50+1E-12);
+    N50 = powf(mean, 2.0);
+    N50dB = 10.0*log10f(N50+1E-12);
 
     /* Now multiply by (3000 Hz)/(50 Hz) to find the total noise power
        in 3000 Hz */
 
-    N3000dB = N50dB + 10.0*log10(3000.0/RS);
+    N3000dB = N50dB + 10.0*log10f(3000.0/RS);
 
     snr_dB = SdB - N3000dB;
 
@@ -1607,7 +1632,7 @@ void fdmdv_get_rx_spectrum(struct FDMDV *f, float mag_spec_dB[],
     /* scale and convert to dB */
 
     for(i=0; i<FDMDV_NSPEC; i++) {
-	mag_spec_dB[i]  = 10.0*log10(fft_out[i].real*fft_out[i].real + fft_out[i].imag*fft_out[i].imag + 1E-12);
+	mag_spec_dB[i]  = 10.0*log10f(fft_out[i].real*fft_out[i].real + fft_out[i].imag*fft_out[i].imag + 1E-12);
 	mag_spec_dB[i] -= full_scale_dB;
     }
 }
@@ -1625,14 +1650,14 @@ void fdmdv_dump_osc_mags(struct FDMDV *f)
 
     fprintf(stderr, "phase_tx[]:\n");
     for(i=0; i<=f->Nc; i++)
-	fprintf(stderr,"  %1.3f", cabsolute(f->phase_tx[i]));
+	fprintf(stderr,"  %1.3f", (double)cabsolute(f->phase_tx[i]));
     fprintf(stderr,"\nfreq[]:\n");
     for(i=0; i<=f->Nc; i++)
-	fprintf(stderr,"  %1.3f", cabsolute(f->freq[i]));
-    fprintf(stderr,"\nfoff_phase_rect: %1.3f", cabsolute(f->foff_phase_rect));
+	fprintf(stderr,"  %1.3f", (double)cabsolute(f->freq[i]));
+    fprintf(stderr,"\nfoff_phase_rect: %1.3f", (double)cabsolute(f->foff_phase_rect));
     fprintf(stderr,"\nphase_rx[]:\n");
     for(i=0; i<=f->Nc; i++)
-	fprintf(stderr,"  %1.3f", cabsolute(f->phase_rx[i]));
+	fprintf(stderr,"  %1.3f", (double)cabsolute(f->phase_rx[i]));
     fprintf(stderr, "\n\n");
 }
 
diff --git a/codec2-dev/stm32/Makefile b/codec2-dev/stm32/Makefile
index 661b21aa..fcaea9a1 100644
--- a/codec2-dev/stm32/Makefile
+++ b/codec2-dev/stm32/Makefile
@@ -13,7 +13,7 @@ SIZE=$(BINPATH)/arm-none-eabi-size
 
 ###################################################
 
-CFLAGS  = -std=gnu99 -O0 -g -Wall -Tstm32_flash.ld -DSTM32F4XX -DCORTEX_M4
+CFLAGS  = -std=gnu99 -O2 -g -Wall -Tstm32_flash.ld -DSTM32F4XX -DCORTEX_M4
 CFLAGS += -mlittle-endian -mthumb -mthumb-interwork -nostartfiles -mcpu=cortex-m4
 
 ifeq ($(FLOAT_TYPE), hard)
diff --git a/codec2-dev/stm32/src/fdmdv_profile.c b/codec2-dev/stm32/src/fdmdv_profile.c
index 2826b309..988152e4 100644
--- a/codec2-dev/stm32/src/fdmdv_profile.c
+++ b/codec2-dev/stm32/src/fdmdv_profile.c
@@ -48,14 +48,47 @@
 #endif
 
 #define TEST_FRAMES 25
+#define CHANNEL_BUF_SIZE (10*FDMDV_NOM_SAMPLES_PER_FRAME)
+
+static int  channel_count = 0;
+static COMP channel[CHANNEL_BUF_SIZE];
+
+static void channel_in(COMP tx_fdm[], int nout) {
+    int i;
+
+    /* add M tx samples to end of buffer */
+
+    assert((channel_count + nout) < CHANNEL_BUF_SIZE);
+    for(i=0; i<nout; i++)
+        channel[channel_count+i] = tx_fdm[i];
+    channel_count += M;
+}
+
+static void channel_out(COMP rx_fdm[], int nin) {
+    int i,j;
+
+    /* take nin samples from start of buffer */
+
+    for(i=0; i<nin; i++) {
+        rx_fdm[i] = channel[i];
+    }
+
+    /* shift buffer back */
+
+    for(i=0,j=nin; j<channel_count; i++,j++)
+        channel[i] = channel[j];
+    channel_count -= nin;
+}
 
 int main(int argc, char *argv[]) {
     struct FDMDV       *fdmdv;
     int                 bits_per_fdmdv_frame,  bits_per_codec_frame;
     int                *tx_bits;
     int                *rx_bits;
+    int                *codec_bits;
     COMP                tx_fdm[2*FDMDV_NOM_SAMPLES_PER_FRAME];
-    int                 i, nin, reliable_sync_bit, sync_bit, bit_errors, ntest_bits, test_frame_sync;
+    COMP                rx_fdm[FDMDV_NOM_SAMPLES_PER_FRAME];
+    int                 i, j, nin, reliable_sync_bit[2], sync_bit, bit_errors, ntest_bits, test_frame_sync;
     short              *error_pattern;
     struct FDMDV_STATS  stats;
     TIMER_VAR(mod_start, demod_start);
@@ -67,9 +100,11 @@ int main(int argc, char *argv[]) {
     bits_per_codec_frame = 2*fdmdv_bits_per_frame(fdmdv);
     tx_bits = (int*)malloc(sizeof(int)*bits_per_codec_frame); assert(tx_bits != NULL);
     rx_bits = (int*)malloc(sizeof(int)*bits_per_codec_frame); assert(rx_bits != NULL);
+    codec_bits = (int*)malloc(sizeof(int)*bits_per_codec_frame); assert(rx_bits != NULL);
     error_pattern = (short*)malloc(fdmdv_error_pattern_size(fdmdv)*sizeof(int)); assert(error_pattern != NULL);
 
     nin = FDMDV_NOM_SAMPLES_PER_FRAME;
+    test_frame_sync = 0;
 
     for(i=0; i<TEST_FRAMES; i++) {
 	fdmdv_get_test_bits(fdmdv, tx_bits);
@@ -81,19 +116,29 @@ int main(int argc, char *argv[]) {
 	assert(sync_bit == 1);
 	fdmdv_mod(fdmdv, &tx_fdm[FDMDV_NOM_SAMPLES_PER_FRAME], &tx_bits[bits_per_fdmdv_frame], &sync_bit);
 	assert(sync_bit == 0);
+        channel_in(tx_fdm, 2*FDMDV_NOM_SAMPLES_PER_FRAME);
 
         TIMER_SAMPLE_AND_LOG(demod_start, mod_start, "  mod");     
 
-        fdmdv_demod(fdmdv, rx_bits, &reliable_sync_bit, tx_fdm, &nin);
-        fdmdv_demod(fdmdv, &rx_bits[bits_per_fdmdv_frame], &reliable_sync_bit, &tx_fdm[FDMDV_NOM_SAMPLES_PER_FRAME], &nin);
+        for(j=0; j<2; j++) {
+            channel_out(rx_fdm, nin);
+            fdmdv_demod(fdmdv, rx_bits, &reliable_sync_bit[j], rx_fdm, &nin);
+            if (reliable_sync_bit[j] == 0)
+                memcpy(codec_bits, rx_bits, bits_per_fdmdv_frame*sizeof(int));
+            else {
+                memcpy(&codec_bits[bits_per_fdmdv_frame], rx_bits, bits_per_fdmdv_frame*sizeof(int));
+                fdmdv_put_test_bits(fdmdv, &test_frame_sync, error_pattern, &bit_errors, &ntest_bits, codec_bits);
+                fdmdv_put_test_bits(fdmdv, &test_frame_sync, error_pattern, &bit_errors, &ntest_bits, &codec_bits[bits_per_fdmdv_frame]);
+            }
+        }
         TIMER_SAMPLE_AND_LOG2(demod_start, "  demod");     
         TIMER_SAMPLE_AND_LOG2(mod_start, "  mod & demod");     
 
         fdmdv_get_demod_stats(fdmdv, &stats);
-        fdmdv_put_test_bits(fdmdv, &test_frame_sync, error_pattern, &bit_errors, &ntest_bits, rx_bits);
 
-        printf("frame: %d sync: %d reliable_sync_bit: %d SNR: %3.2f test_frame_sync: %d\n", 
-               i, stats.sync, reliable_sync_bit, (double)stats.snr_est, test_frame_sync);
+        printf("frame: %d sync: %d reliable_sync_bit: %d %d SNR: %3.2f test_frame_sync: %d\n", 
+               i, stats.sync, reliable_sync_bit[0], reliable_sync_bit[1], (double)stats.snr_est, 
+               test_frame_sync);
         machdep_timer_print_logged_samples();
     }