From: drowe67 <drowe67@01035d8c-6547-0410-b346-abe4f91aad63>
Date: Wed, 15 Feb 2012 03:05:14 +0000 (+0000)
Subject: added bit error generation to c2dec
X-Git-Url: http://git.whiteaudio.com/gitweb/?a=commitdiff_plain;h=51349d0ba79faa17fb12af59fa3f3c4a2c45ae90;p=freetel-svn-tracking.git

added bit error generation to c2dec

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

diff --git a/codec2-dev/src/c2dec.c b/codec2-dev/src/c2dec.c
index 56cfcca7..e5dc7a39 100644
--- a/codec2-dev/src/c2dec.c
+++ b/codec2-dev/src/c2dec.c
@@ -40,9 +40,10 @@ int main(int argc, char *argv[])
     FILE          *fout;
     short         *buf;
     unsigned char *bits;
-    int            nsam, nbit, nbyte;
+    int            nsam, nbit, nbyte, i, byte, frames, bit_errors;
+    float          ber, r;
 
-    if (argc != 4) {
+    if (argc < 4) {
 	printf("usage: c2dec 2500|1500|1125 InputBitFile OutputRawSpeechFile\n");
 	printf("e.g    c2dec 1500 hts1a.c2 hts1a_1500.raw\n");
 	exit(1);
@@ -73,23 +74,43 @@ int main(int argc, char *argv[])
 	exit(1);
     }
 
+    if (argc == 5)
+	ber = atof(argv[4]);
+    else
+	ber = 0.0;
+
     codec2 = codec2_create(mode);
     nsam = codec2_samples_per_frame(codec2);
     nbit = codec2_bits_per_frame(codec2);
     buf = (short*)malloc(nsam*sizeof(short));
     nbyte = (nbit + 7) / 8;
     bits = (unsigned char*)malloc(nbyte*sizeof(char));
-    
+    frames = bit_errors = 0;
+
     while(fread(bits, sizeof(char), nbyte, fin) == nbyte) {
+	frames++;
+	if (ber != 0.0) {
+	    for(i=0; i<nbit; i++) {
+		r = (float)rand()/RAND_MAX;
+		if (r < ber) {
+		    byte = i/8;
+		    //printf("nbyte %d nbit %d i %d byte %d\n", nbyte, nbit, i, byte);
+		    bits[byte] ^= 1 << (i - byte*8);
+		    bit_errors++;
+		}
+	    }
+	}
 	codec2_decode(codec2, buf, bits);
  	fwrite(buf, sizeof(short), nsam, fout);
 	//if this is in a pipeline, we probably don't want the usual
         //buffering to occur
         if (fout == stdout) fflush(stdout);
-        if (fin == stdin) fflush(stdin);
-          
+        if (fin == stdin) fflush(stdin);         
     }
 
+    if (ber != 0.0)
+	printf("actual BER: %1.3f\n", (float)bit_errors/(frames*nbit));
+
     codec2_destroy(codec2);
 
     free(buf);
diff --git a/codec2-dev/src/codec2.c b/codec2-dev/src/codec2.c
index bb01bd66..6204e9e0 100644
--- a/codec2-dev/src/codec2.c
+++ b/codec2-dev/src/codec2.c
@@ -596,6 +596,7 @@ void codec2_decode_1500(struct CODEC2 *c2, short speech[], const unsigned char *
     /* decode frame 2 LSPs and model amplitudes */
 
     decode_lsps_scalar(lsps_, lsp_indexes, LPC_ORD);
+    check_lsp_order(lsps_, LPC_ORD);
     bw_expand_lsps(lsps_, LPC_ORD);
     lsp_to_lpc(lsps_, ak, LPC_ORD);
     energy = decode_energy(energy_index);
diff --git a/codec2-dev/src/quantise.c b/codec2-dev/src/quantise.c
index 09e81627..33e1e4e5 100644
--- a/codec2-dev/src/quantise.c
+++ b/codec2-dev/src/quantise.c
@@ -534,7 +534,7 @@ void check_lsp_order(float lsp[], int lpc_order)
 
     for(i=1; i<lpc_order; i++)
 	if (lsp[i] < lsp[i-1]) {
-	    printf("swap %d\n",i);
+	    //printf("swap %d\n",i);
 	    tmp = lsp[i-1];
 	    lsp[i-1] = lsp[i]-0.05;
 	    lsp[i] = tmp+0.05;
diff --git a/codec2-dev/src/quantise.h b/codec2-dev/src/quantise.h
index 6e04173d..bad8137c 100644
--- a/codec2-dev/src/quantise.h
+++ b/codec2-dev/src/quantise.h
@@ -94,6 +94,7 @@ float speech_to_uq_lsps(float lsp[],
 		        float w[],
 		        int   order
 			);
+void check_lsp_order(float lsp[], int lpc_order);
 void bw_expand_lsps(float lsp[], int order);
 void locate_lsps_jnd_steps(float lsp[], int order);