/******************************************************************
   
       iLBC Speech Coder ANSI-C Source Code
   
       iCBConstruct.c 
   
       Copyright (C) The Internet Society (2004). 
       All Rights Reserved.
   
   ******************************************************************/
   
   #include <math.h>
   
   #include "iLBC_define.h"
   #include "gainquant.h"
   #include "getCBvec.h"
   
   /*----------------------------------------------------------------*
    *  Convert the codebook indexes to make the search easier
    *---------------------------------------------------------------*/
   
   
   
   void index_conv_enc(
       int *index          /* (i/o) Codebook indexes */
   ){
       int k;
   
       for (k=1; k<CB_NSTAGES; k++) {
           
           if ((index[k]>=108)&&(index[k]<172)) {
               index[k]-=64;
           } else if (index[k]>=236) {
               index[k]-=128;
           } else {
               /* ERROR */
           }
       }
   }
   
   void index_conv_dec(
       int *index          /* (i/o) Codebook indexes */
   ){
       int k;
   
       for (k=1; k<CB_NSTAGES; k++) {
           
           if ((index[k]>=44)&&(index[k]<108)) {
               index[k]+=64;
           } else if ((index[k]>=108)&&(index[k]<128)) {
               index[k]+=128;
           } else {
               /* ERROR */
           }
       }
   }
   
   /*----------------------------------------------------------------*
    *  Construct decoded vector from codebook and gains.
    *---------------------------------------------------------------*/
   
   void iCBConstruct(
       float *decvector,   /* (o) Decoded vector */
       int *index,         /* (i) Codebook indices */
       int *gain_index,/* (i) Gain quantization indices */
       float *mem,         /* (i) Buffer for codevector construction */
       int lMem,           /* (i) Length of buffer */
       int veclen,         /* (i) Length of vector */
       int nStages         /* (i) Number of codebook stages */
   ){
       int j,k;
       float gain[CB_NSTAGES];
       float cbvec[SUBL];
   
       /* gain de-quantization */
   
       gain[0] = gaindequant(gain_index[0], 1.0, 32);
   
   
       if (nStages > 1) {
           gain[1] = gaindequant(gain_index[1], 
               (float)fabs(gain[0]), 16);  
       }
       if (nStages > 2) {
           gain[2] = gaindequant(gain_index[2], 
               (float)fabs(gain[1]), 8);
       }
   
       /* codebook vector construction and construction of 
       total vector */
   
       getCBvec(cbvec, mem, index[0], lMem, veclen);
       for (j=0;j<veclen;j++){
           decvector[j] = gain[0]*cbvec[j];
       }
       if (nStages > 1) {
           for (k=1; k<nStages; k++) {
               getCBvec(cbvec, mem, index[k], lMem, veclen);
               for (j=0;j<veclen;j++) {
                   decvector[j] += gain[k]*cbvec[j];
               }
           }
       }
   }