From 8e5c2c36f6584d88c6dbe0ce1f47c09d75c818fc Mon Sep 17 00:00:00 2001
From: drowe67 <drowe67@01035d8c-6547-0410-b346-abe4f91aad63>
Date: Mon, 31 Oct 2011 07:22:39 +0000
Subject: [PATCH] --lspd mode with scalr LSP differences for lsp1-4, then VQ in
 log domain of lsp5-10.  Tried a 1024 element VQ but errors propogate so
 pretty rougfh results

git-svn-id: https://svn.code.sf.net/p/freetel/code@294 01035d8c-6547-0410-b346-abe4f91aad63
---
 codec2-dev/src/Makefile.am    |  7 +----
 codec2-dev/src/Makefile.in    |  7 +----
 codec2-dev/src/c2sim.c        |  2 ++
 codec2-dev/src/quantise.c     | 44 +++++++++++++++++++++++++++----
 codec2-dev/unittest/genlsp.c  |  3 ++-
 codec2-dev/unittest/vqtrain.c | 49 +++--------------------------------
 6 files changed, 48 insertions(+), 64 deletions(-)

diff --git a/codec2-dev/src/Makefile.am b/codec2-dev/src/Makefile.am
index b890b101..93995db9 100644
--- a/codec2-dev/src/Makefile.am
+++ b/codec2-dev/src/Makefile.am
@@ -26,12 +26,7 @@ CODEBOOKSD= \
   $D/dlsp2.txt \
   $D/dlsp3.txt \
   $D/dlsp4.txt \
-  $D/dlsp5.txt \
-  $D/dlsp6.txt \
-  $D/dlsp7.txt \
-  $D/dlsp8.txt \
-  $D/dlsp9.txt \
-  $D/dlsp10.txt
+  $(top_srcdir)/unittest/lspdlog5-10_1024.txt
 
 # lspd VQ quantisers
 
diff --git a/codec2-dev/src/Makefile.in b/codec2-dev/src/Makefile.in
index ab73357c..0c3274c4 100644
--- a/codec2-dev/src/Makefile.in
+++ b/codec2-dev/src/Makefile.in
@@ -240,12 +240,7 @@ CODEBOOKSD = \
   $D/dlsp2.txt \
   $D/dlsp3.txt \
   $D/dlsp4.txt \
-  $D/dlsp5.txt \
-  $D/dlsp6.txt \
-  $D/dlsp7.txt \
-  $D/dlsp8.txt \
-  $D/dlsp9.txt \
-  $D/dlsp10.txt
+  $(top_srcdir)/unittest/lspdlog5-10_1024.txt
 
 
 # lspd VQ quantisers
diff --git a/codec2-dev/src/c2sim.c b/codec2-dev/src/c2sim.c
index 8c12786f..f6df412c 100644
--- a/codec2-dev/src/c2sim.c
+++ b/codec2-dev/src/c2sim.c
@@ -369,6 +369,7 @@ int main(int argc, char *argv[])
 #endif
     }
 
+#ifdef RESAMPLE
     /* optional resampling of model amplitudes */
 
     //printf("frames=%d\n", frames);
@@ -379,6 +380,7 @@ int main(int argc, char *argv[])
         dump_quantised_model(&model);
 #endif
     }
+#endif
 
     /* option decimation to 20ms rate, which enables interpolation
        routine to synthesise in between frame */
diff --git a/codec2-dev/src/quantise.c b/codec2-dev/src/quantise.c
index 58e5d2d4..1f3443fe 100644
--- a/codec2-dev/src/quantise.c
+++ b/codec2-dev/src/quantise.c
@@ -120,7 +120,7 @@ long quantise(const float * cb, float vec[], float w[], int k, int m, float *se)
 									      
   lspd_quantise
 
-  Scalar lsp difference quantiser.
+  Scalar/VQ LSP difference quantiser.
 
 \*---------------------------------------------------------------------------*/
 
@@ -130,16 +130,20 @@ void lspd_quantise(
   int   order
 ) 
 {
-    int   i,k,m;
+    int   i,k,m,ncb, nlsp, index;
     float lsp_hz[LPC_MAX];
     float lsp__hz[LPC_MAX];
     float dlsp[LPC_MAX];
     float dlsp_[LPC_MAX];
-    float  wt[1];
+    float wt[LPC_MAX];
     const float *cb;
     float se;
     int   indexes[LPC_MAX];
 
+    for(i=0; i<LPC_ORD; i++) {
+	wt[i] = 1.0;
+    }
+
     /* convert from radians to Hz so we can use human readable
        frequencies */
 
@@ -150,7 +154,7 @@ void lspd_quantise(
     for(i=1; i<order; i++)
     	dlsp[i] = lsp_hz[i] - lsp_hz[i-1];
 
-    /* simple uniform scalar quantisers */
+    /* simple uniform scalar quantisers for LSP differences 1..4 */
 
     wt[0] = 1.0;
     for(i=0; i<4; i++) {
@@ -170,9 +174,39 @@ void lspd_quantise(
 	else
 	    lsp__hz[0] = dlsp_[0];
     }
+
+    /* VQ LSP differences 5..10 in log domain */
+
+    ncb = 4;
+    nlsp = 4;
+    k = lsp_cbd[ncb].k;
+    m = lsp_cbd[ncb].m;
+    cb = lsp_cbd[ncb].cb;
+    for(i=4; i<order; i++) {
+	dlsp[i] = log10((PI/4000.0)*dlsp[i]);
+	printf("%f ", dlsp[i]);
+    }
+    printf("\n");
+    index = quantise(cb, &dlsp[nlsp], &wt[nlsp], k, m, &se);
+    for(i=0; i<6; i++)
+ 	printf("%f ", cb[i]);
+    printf("\n");
+    printf("index = %d\n", index);
+    for(i=4; i<order; i++) {
+	dlsp_[i] = (4000.0/PI)*pow(10.0, cb[index*k+i-nlsp]);
+	printf("%f ", cb[index*k+i-nlsp]);
+	lsp__hz[i] = lsp__hz[i-1] + dlsp_[i];
+    }
+    printf("\n");
+    for(i=4; i<order; i++)
+ 	printf("%f ", dlsp_[i]);
+    printf("\n\n");
+
+    /*
     for(; i<order; i++)
     	lsp__hz[i] = lsp_hz[i];
-    
+    */
+
     /* convert back to radians */
 
     for(i=0; i<order; i++)
diff --git a/codec2-dev/unittest/genlsp.c b/codec2-dev/unittest/genlsp.c
index 35417d9c..c284a9e3 100644
--- a/codec2-dev/unittest/genlsp.c
+++ b/codec2-dev/unittest/genlsp.c
@@ -31,6 +31,7 @@
 #define NW	279	/* frame size in samples 			*/
 #define	N  	80 	/* frame to frame shift				*/
 #define THRESH	40.0	/* threshold energy/sample for frame inclusion 	*/
+#define PI         3.141592654	/* mathematical constant                */
 
 #include <stdio.h>
 #include <stdlib.h>
@@ -132,7 +133,7 @@ int main(int argc, char *argv[]) {
 			fprintf(flsp,"%f ",log10(lsp[0]));
 			for(i=1; i<P; i++) {
 			    diff = lsp[i]-lsp[i-1];
-			    if (diff < 25.0) diff = 25.0;
+			    if (diff < (PI/4000.0)*25.0) diff = (PI/4000.0)*25.0;
 			    fprintf(flsp,"%f ",log10(diff));
 			}
 		    } 
diff --git a/codec2-dev/unittest/vqtrain.c b/codec2-dev/unittest/vqtrain.c
index 9ca7b03d..ef423158 100644
--- a/codec2-dev/unittest/vqtrain.c
+++ b/codec2-dev/unittest/vqtrain.c
@@ -57,9 +57,6 @@ void zero(float v[], int k);
 void acc(float v1[], float v2[], int k);
 void norm(float v[], int k, long n);
 long quantise(float cb[], float vec[], int k, int m, float *se);
-void jnd(float x[], int k);
-
-float pi;
 
 /*-----------------------------------------------------------------------* \
 
@@ -81,8 +78,7 @@ int main(int argc, char *argv[]) {
     float  delta;	/* improvement in distortion 			*/
     FILE   *ftrain;	/* file containing training set			*/
     FILE   *fvq;	/* file containing vector quantiser		*/
-
-    pi = 4.0*atan(1.0);
+    int     ret;
 
     /* Interpret command line arguments */
 
@@ -123,7 +119,7 @@ int main(int argc, char *argv[]) {
     /* set up initial codebook state from samples of training set */
 
     rewind(ftrain);
-    fread(cb, sizeof(float), k*m, ftrain);
+    ret = fread(cb, sizeof(float), k*m, ftrain);
 
     /* main loop */
 
@@ -144,7 +140,7 @@ int main(int argc, char *argv[]) {
 	se = 0.0;
 	rewind(ftrain);
 	for(i=0; i<J; i++) {
-	    fread(vec, sizeof(float), k, ftrain);
+	    ret = fread(vec, sizeof(float), k, ftrain);
 	    ind = quantise(cb, vec, k, m, &se);
 	    n[ind]++;
 	    acc(&cent[ind*k], vec, k);
@@ -167,30 +163,6 @@ int main(int argc, char *argv[]) {
 
     } while (delta > DELTAQ);
 
-    /* check % within JND */
-
-    {
-	long jnd;
-        int  cur_jnd;
-	float diff, jnd_thresh = 50.0*pi/4000.0;
-
-	jnd = 0;
-	se = 0.0;
-	rewind(ftrain);
-	for(i=0; i<J; i++) {
-	    fread(vec, sizeof(float), k, ftrain);
-	    ind = quantise(cb, vec, k, m, &se);
-	    cur_jnd = 0;
-	    for(j=0; j<k; j++) {
-		diff = cb[k*ind+j] - vec[j];
-		if (fabs(diff) > jnd_thresh)
-		    cur_jnd = 1;
-		if (cur_jnd) jnd++;
-	    }
-	}
-	printf("jnd %3.2f %%\n", 100.0*(float)jnd/(J*k));
-    }
-
     /* save codebook to disk */
 
     fvq = fopen(argv[4],"wt");
@@ -327,18 +299,3 @@ long quantise(float cb[], float vec[], int k, int m, float *se)
    return(besti);
 }
 
-void jnd(float x[], int k) {
-    float lsp_hz, step = 100.0;
-    int   i;
-
-    for(i=0; i<k; i++) {
-	lsp_hz = x[i]*4000.0/pi;
-	lsp_hz = floor(lsp_hz/step + 0.5)*step;
-	x[i] = lsp_hz*pi/4000.0;
-	if (i) {
-	    if (x[i] == x[i-1])
-		x[i] += step*pi/4000.0;
-
-	}
-    }
-}
-- 
2.25.1