/*
********************************************************************************
*
*      GSM AMR-NB speech codec   R98   Version 7.6.0   December 12, 2001
*                                R99   Version 3.3.0                
*                                REL-4 Version 4.1.0                
*
********************************************************************************
*
*      File             : d_plsf_3.c
*      Purpose          : Decodes the LSP parameters using the received
*                         quantization indices. 1st order MA prediction and
*                         split by 3 vector quantization (split-VQ)
*
********************************************************************************
*/

/*
********************************************************************************
*                         MODULE INCLUDE FILE AND VERSION ID
********************************************************************************
*/
#include "d_plsf.h"
const char d_plsf_3_id[] = "@(#)$Id $" d_plsf_h;


/*
********************************************************************************
*                         INCLUDE FILES
********************************************************************************
*/
#include <stdlib.h>
#include <stdio.h>
#include "typedef.h"
#include "basic_op.h"
#include "count.h"
#include "lsp_lsf.h"
#include "reorder.h"
#include "copy.h"

/*
********************************************************************************
*                         LOCAL VARIABLES AND TABLES
********************************************************************************
*/
#include "q_plsf_3.tab"    /* Codebooks of LSF prediction residual */

/* ALPHA    ->  0.9                                            */
/* ONE_ALPHA-> (1.0-ALPHA)                                     */

#define ALPHA     29491
#define ONE_ALPHA 3277

/*
********************************************************************************
*                         PUBLIC PROGRAM CODE
********************************************************************************
*/
/*************************************************************************
 *
 *  FUNCTION:   D_plsf_3()
 *
 *  PURPOSE: Decodes the LSP parameters using the received quantization
 *           indices.1st order MA prediction and split by 3 vector
 *           quantization (split-VQ)
 *
 *************************************************************************/

void D_plsf_3(
    D_plsfState *st,   /* i/o: State struct                               */
    enum Mode mode,    /* i  : coder mode                                 */
    Word16 bfi,        /* i  : bad frame indicator (set to 1 if a         */
                       /*      bad frame is received)                     */
    Word16 * indice,   /* i  : quantization indices of 3 submatrices, Q0  */
    Word16 * lsp1_q    /* o  : quantized 1st LSP vector,              Q15 */
)
{
    Word16 i, index;
    Word16 *p_cb1, *p_cb2, *p_cb3, *p_dico, temp;
    Word16 lsf1_r[M];
    Word16 lsf1_q[M];
    
    test ();
    if (bfi != 0)   /* if bad frame */
    {
        /* use the past LSFs slightly shifted towards their mean */

        for (i = 0; i < M; i++)
        {
            /* lsfi_q[i] = ALPHA*past_lsf_q[i] + ONE_ALPHA*mean_lsf[i]; */

            lsf1_q[i] = add_ex(mult_ex(st->past_lsf_q[i], ALPHA),
                            mult_ex(mean_lsf[i], ONE_ALPHA));
                                                move16 ();
        }

        /* estimate past quantized residual to be used in next frame */
	test();
	if (sub_ex(mode, MRDTX) != 0) {
	  for (i = 0; i < M; i++) {
            /* temp  = mean_lsf[i] +  past_r2_q[i] * PRED_FAC; */
	    
            temp = add_ex(mean_lsf[i], mult_ex(st->past_r_q[i], pred_fac[i]));
	    
            st->past_r_q[i] = sub_ex(lsf1_q[i], temp);                   move16 ();
	  }
	} else {
	  for (i = 0; i < M; i++) {
            /* temp  = mean_lsf[i] +  past_r2_q[i]; */
	    
            temp = add_ex(mean_lsf[i], st->past_r_q[i]);
            st->past_r_q[i] = sub_ex(lsf1_q[i], temp);                   move16 ();
	  }	  
	}
    }
    else  /* if good LSFs received */
    {
       test (); test ();
       if (sub_ex (mode, MR475) == 0 || sub_ex (mode, MR515) == 0)
       {   /* MR475, MR515 */
          p_cb1 = dico1_lsf;                  move16 ();
          p_cb2 = dico2_lsf;                  move16 ();
          p_cb3 = mr515_3_lsf;                move16 ();
       }
       else if (sub_ex (mode, MR795) == 0)
       {   /* MR795 */
          test();
          p_cb1 = mr795_1_lsf;                move16 ();
          p_cb2 = dico2_lsf;                  move16 ();
          p_cb3 = dico3_lsf;                  move16 ();
       }
       else 
       {   /* MR59, MR67, MR74, MR102, MRDTX */
          test();          
          p_cb1 = dico1_lsf;                  move16 ();
          p_cb2 = dico2_lsf;                  move16 ();
          p_cb3 = dico3_lsf;                  move16 ();
       }
       
       /* decode prediction residuals from 3 received indices */

        index = *indice++;                      move16 ();
        p_dico = &p_cb1[add_ex(index, add_ex(index, index))];               move16 ();
        lsf1_r[0] = *p_dico++;                  move16 ();
        lsf1_r[1] = *p_dico++;                  move16 ();
        lsf1_r[2] = *p_dico++;                  move16 ();

        index = *indice++;                      move16 ();
        
        test (); test ();
        if ((sub_ex (mode, MR475) == 0) || (sub_ex (mode, MR515) == 0))
        {   /* MR475, MR515 only using every second entry */
            index = shl_ex(index,1);
        }
        
        p_dico = &p_cb2[add_ex(index, add_ex(index, index))];               move16 ();
        lsf1_r[3] = *p_dico++;                  move16 ();
        lsf1_r[4] = *p_dico++;                  move16 ();
        lsf1_r[5] = *p_dico++;                  move16 ();

        index = *indice++;                      move16 ();
        p_dico = &p_cb3[shl_ex(index, 2)];         move16 ();
        lsf1_r[6] = *p_dico++;                  move16 ();
        lsf1_r[7] = *p_dico++;                  move16 ();
        lsf1_r[8] = *p_dico++;                  move16 ();
        lsf1_r[9] = *p_dico++;                  move16 ();

        /* Compute quantized LSFs and update the past quantized residual */

	if (sub_ex(mode, MRDTX) != 0) 
           for (i = 0; i < M; i++) {
              temp = add_ex(mean_lsf[i], mult_ex(st->past_r_q[i], pred_fac[i]));
              lsf1_q[i] = add_ex(lsf1_r[i], temp);   move16 ();
              st->past_r_q[i] = lsf1_r[i];        move16 ();
           }
        else
           for (i = 0; i < M; i++) {
              temp = add_ex(mean_lsf[i], st->past_r_q[i]);
              lsf1_q[i] = add_ex(lsf1_r[i], temp);   move16 ();
              st->past_r_q[i] = lsf1_r[i];        move16 ();
           }
    }

    /* verification that LSFs has minimum distance of LSF_GAP Hz */

    Reorder_lsf(lsf1_q, LSF_GAP, M);

    Copy (lsf1_q, st->past_lsf_q, M);

    /*  convert LSFs to the cosine domain */

    Lsf_lsp(lsf1_q, lsp1_q, M);

    return;
}

void Init_D_plsf_3(D_plsfState *st,  /* i/o: State struct                */
		   Word16 index      /* i  : past_rq_init[] index [0, 7] */)
{
  Copy(&past_rq_init[index * M], st->past_r_q, M);
}