开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 通讯/手机编程 > 语音压缩 > 查看源码
QUA_LSP.C
资源名称：G711-729.rar　[点击查看]
上传用户：meifeng08
上传日期：2013-06-18
资源大小：5304k
文件大小：10k
源码类别：

语音压缩

开发平台：

C/C++

QUA_LSP.C：源码内容
  1. /*
  2.    ITU-T G.729A Speech Coder    ANSI-C Source Code
  3.    Version 1.1    Last modified: September 1996
  5.    Copyright (c) 1996,
  6.    AT&T, France Telecom, NTT, Universite de Sherbrooke
  7.    All rights reserved.
  8. */
  10. /*-------------------------------------------------------------------*
  11.  * Function  Qua_lsp:                                                *
  12.  *           ~~~~~~~~                                                *
  13.  *-------------------------------------------------------------------*/
  14. #include "typedef.h"
  15. #include "basic_op.h"
  17. #include "ld8a.h"
  18. #include "tab_ld8a.h"
  20. void Qua_lsp(
  21.   Word16 lsp[],       /* (i) Q15 : Unquantized LSP            */
  22.   Word16 lsp_q[],     /* (o) Q15 : Quantized LSP              */
  23.   Word16 ana[]        /* (o)     : indexes                    */
  24. )
  25. {
  26.   Word16 lsf[M], lsf_q[M];  /* domain 0.0<= lsf <PI in Q13 */
  28.   /* Convert LSPs to LSFs */
  29.   Lsp_lsf2(lsp, lsf, M);
  31.   Lsp_qua_cs(lsf, lsf_q, ana );
  33.   /* Convert LSFs to LSPs */
  34.   Lsf_lsp2(lsf_q, lsp_q, M);
  36.   return;
  37. }
  39. /* static memory */
  41. static Word16 freq_prev[MA_NP][M];    /* Q13:previous LSP vector       */
  42. static Word16 freq_prev_reset[M] = {  /* Q13:previous LSP vector(init) */
  43.   2339, 4679, 7018, 9358, 11698, 14037, 16377, 18717, 21056, 23396
  44. };     /* PI*(float)(j+1)/(float)(M+1) */
  47. void Lsp_encw_reset(
  48.   void
  49. )
  50. {
  51.   Word16 i;
  53.   for(i=0; i<MA_NP; i++)
  54.     Copy( &freq_prev_reset[0], &freq_prev[i][0], M );
  55. }
  58. void Lsp_qua_cs(
  59.   Word16 flsp_in[M],    /* (i) Q13 : Original LSP parameters    */
  60.   Word16 lspq_out[M],   /* (o) Q13 : Quantized LSP parameters   */
  61.   Word16 *code          /* (o)     : codes of the selected LSP  */
  62. )
  63. {
  64.   Word16 wegt[M];       /* Q11->normalized : weighting coefficients */
  66.   Get_wegt( flsp_in, wegt );
  68.   Relspwed( flsp_in, wegt, lspq_out, lspcb1, lspcb2, fg,
  69.     freq_prev, fg_sum, fg_sum_inv, code);
  70. }
  72. void Relspwed(
  73.   Word16 lsp[],                 /* (i) Q13 : unquantized LSP parameters */
  74.   Word16 wegt[],                /* (i) norm: weighting coefficients     */
  75.   Word16 lspq[],                /* (o) Q13 : quantized LSP parameters   */
  76.   Word16 lspcb1[][M],           /* (i) Q13 : first stage LSP codebook   */
  77.   Word16 lspcb2[][M],           /* (i) Q13 : Second stage LSP codebook  */
  78.   Word16 fg[MODE][MA_NP][M],    /* (i) Q15 : MA prediction coefficients */
  79.   Word16 freq_prev[MA_NP][M],   /* (i) Q13 : previous LSP vector        */
  80.   Word16 fg_sum[MODE][M],       /* (i) Q15 : present MA prediction coef.*/
  81.   Word16 fg_sum_inv[MODE][M],   /* (i) Q12 : inverse coef.              */
  82.   Word16 code_ana[]             /* (o)     : codes of the selected LSP  */
  83. )
  84. {
  85.   Word16 mode, j;
  86.   Word16 index, mode_index;
  87.   Word16 cand[MODE], cand_cur;
  88.   Word16 tindex1[MODE], tindex2[MODE];
  89.   Word32 L_tdist[MODE];         /* Q26 */
  90.   Word16 rbuf[M];               /* Q13 */
  91.   Word16 buf[M];                /* Q13 */
  93.   for(mode = 0; mode<MODE; mode++) {
  94.     Lsp_prev_extract(lsp, rbuf, fg[mode], freq_prev, fg_sum_inv[mode]);
  96.     Lsp_pre_select(rbuf, lspcb1, &cand_cur );
  97.     cand[mode] = cand_cur;
  99.     Lsp_select_1(rbuf, lspcb1[cand_cur], wegt, lspcb2, &index);
  101.     tindex1[mode] = index;
  103.     for( j = 0 ; j < NC ; j++ )
  104.       buf[j] = add( lspcb1[cand_cur][j], lspcb2[index][j] );
  106.     Lsp_expand_1(buf, GAP1);
  108.     Lsp_select_2(rbuf, lspcb1[cand_cur], wegt, lspcb2, &index);
  110.     tindex2[mode] = index;
  112.     for( j = NC ; j < M ; j++ )
  113.       buf[j] = add( lspcb1[cand_cur][j], lspcb2[index][j] );
  115.     Lsp_expand_2(buf, GAP1);
  117.     Lsp_expand_1_2(buf, GAP2);
  119.     Lsp_get_tdist(wegt, buf, &L_tdist[mode], rbuf, fg_sum[mode]);
  120.   }
  122.   Lsp_last_select(L_tdist, &mode_index);
  124.   code_ana[0] = shl( mode_index,NC0_B ) | cand[mode_index];
  125.   code_ana[1] = shl( tindex1[mode_index],NC1_B ) | tindex2[mode_index];
  127.   Lsp_get_quant(lspcb1, lspcb2, cand[mode_index],
  128.       tindex1[mode_index], tindex2[mode_index],
  129.       fg[mode_index], freq_prev, lspq, fg_sum[mode_index]) ;
  131.   return;
  132. }
  135. void Lsp_pre_select(
  136.   Word16 rbuf[],              /* (i) Q13 : target vetor             */
  137.   Word16 lspcb1[][M],         /* (i) Q13 : first stage LSP codebook */
  138.   Word16 *cand                /* (o)     : selected code            */
  139. )
  140. {
  141.   Word16 i, j;
  142.   Word16 tmp;                 /* Q13 */
  143.   Word32 L_dmin;              /* Q26 */
  144.   Word32 L_tmp;               /* Q26 */
  145.   Word32 L_temp;
  147.   /* avoid the worst case. (all over flow) */
  149.   *cand = 0;
  150.   L_dmin = MAX_32;
  151.   for ( i = 0 ; i < NC0 ; i++ ) {
  152.     L_tmp = 0;
  153.     for ( j = 0 ; j < M ; j++ ) {
  154.       tmp = sub(rbuf[j], lspcb1[i][j]);
  155.       L_tmp = L_mac( L_tmp, tmp, tmp );
  156.     }
  158.     L_temp = L_sub(L_tmp,L_dmin);
  159.     if (  L_temp< 0L) {
  160.       L_dmin = L_tmp;
  161.       *cand = i;
  162.     }
  163.   }
  164.   return;
  165. }
  169. void Lsp_select_1(
  170.   Word16 rbuf[],              /* (i) Q13 : target vector             */
  171.   Word16 lspcb1[],            /* (i) Q13 : first stage lsp codebook  */
  172.   Word16 wegt[],              /* (i) norm: weighting coefficients    */
  173.   Word16 lspcb2[][M],         /* (i) Q13 : second stage lsp codebook */
  174.   Word16 *index               /* (o)     : selected codebook index   */
  175. )
  176. {
  177.   Word16 j, k1;
  178.   Word16 buf[M];              /* Q13 */
  179.   Word32 L_dist;              /* Q26 */
  180.   Word32 L_dmin;              /* Q26 */
  181.   Word16 tmp,tmp2;            /* Q13 */
  182.   Word32 L_temp;
  184.   for ( j = 0 ; j < NC ; j++ )
  185.     buf[j] = sub(rbuf[j], lspcb1[j]);
  187.                    /* avoid the worst case. (all over flow) */
  188.   *index = 0;
  189.   L_dmin = MAX_32;
  190.   for ( k1 = 0 ; k1 < NC1 ; k1++ ) {
  191.     L_dist = 0;
  192.     for ( j = 0 ; j < NC ; j++ ) {
  193.       tmp = sub(buf[j], lspcb2[k1][j]);
  194.       tmp2 = mult( wegt[j], tmp );
  195.       L_dist = L_mac( L_dist, tmp2, tmp );
  196.     }
  198.     L_temp =L_sub(L_dist,L_dmin);
  199.     if ( L_temp <0L ) {
  200.       L_dmin = L_dist;
  201.       *index = k1;
  202.     }
  203.   }
  204.   return;
  205. }
  209. void Lsp_select_2(
  210.   Word16 rbuf[],              /* (i) Q13 : target vector             */
  211.   Word16 lspcb1[],            /* (i) Q13 : first stage lsp codebook  */
  212.   Word16 wegt[],              /* (i) norm: weighting coef.           */
  213.   Word16 lspcb2[][M],         /* (i) Q13 : second stage lsp codebook */
  214.   Word16 *index               /* (o)     : selected codebook index   */
  215. )
  216. {
  217.   Word16 j, k1;
  218.   Word16 buf[M];              /* Q13 */
  219.   Word32 L_dist;              /* Q26 */
  220.   Word32 L_dmin;              /* Q26 */
  221.   Word16 tmp,tmp2;            /* Q13 */
  222.   Word32 L_temp;
  224.   for ( j = NC ; j < M ; j++ )
  225.     buf[j] = sub(rbuf[j], lspcb1[j]);
  227.                             /* avoid the worst case. (all over flow) */
  228.   *index = 0;
  229.   L_dmin = MAX_32;
  230.   for ( k1 = 0 ; k1 < NC1 ; k1++ ) {
  231.     L_dist = 0;
  232.     for ( j = NC ; j < M ; j++ ) {
  233.       tmp = sub(buf[j], lspcb2[k1][j]);
  234.       tmp2 = mult( wegt[j], tmp );
  235.       L_dist = L_mac( L_dist, tmp2, tmp );
  236.     }
  238.     L_temp = L_sub(L_dist, L_dmin);
  239.     if ( L_temp <0L ) {
  240.       L_dmin = L_dist;
  241.       *index = k1;
  242.     }
  243.   }
  244.   return;
  245. }
  249. void Lsp_get_tdist(
  250.   Word16 wegt[],        /* (i) norm: weight coef.                */
  251.   Word16 buf[],         /* (i) Q13 : candidate LSP vector        */
  252.   Word32 *L_tdist,      /* (o) Q27 : distortion                  */
  253.   Word16 rbuf[],        /* (i) Q13 : target vector               */
  254.   Word16 fg_sum[]       /* (i) Q15 : present MA prediction coef. */
  255. )
  256. {
  257.   Word16 j;
  258.   Word16 tmp, tmp2;     /* Q13 */
  259.   Word32 L_acc;         /* Q25 */
  261.   *L_tdist = 0;
  262.   for ( j = 0 ; j < M ; j++ ) {
  263.     /* tmp = (buf - rbuf)*fg_sum */
  264.     tmp = sub( buf[j], rbuf[j] );
  265.     tmp = mult( tmp, fg_sum[j] );
  267.     /* *L_tdist += wegt * tmp * tmp */
  268.     L_acc = L_mult( wegt[j], tmp );
  269.     tmp2 = extract_h( L_shl( L_acc, 4 ) );
  270.     *L_tdist = L_mac( *L_tdist, tmp2, tmp );
  271.   }
  273.   return;
  274. }
  278. void Lsp_last_select(
  279.   Word32 L_tdist[],     /* (i) Q27 : distortion         */
  280.   Word16 *mode_index    /* (o)     : the selected mode  */
  281. )
  282. {
  283.     Word32 L_temp;
  284.   *mode_index = 0;
  285.   L_temp =L_sub(L_tdist[1] ,L_tdist[0]);
  286.   if (  L_temp<0L){
  287.     *mode_index = 1;
  288.   }
  289.   return;
  290. }
  292. void Get_wegt(
  293.   Word16 flsp[],    /* (i) Q13 : M LSP parameters  */
  294.   Word16 wegt[]     /* (o) Q11->norm : M weighting coefficients */
  295. )
  296. {
  297.   Word16 i;
  298.   Word16 tmp;
  299.   Word32 L_acc;
  300.   Word16 sft;
  301.   Word16 buf[M]; /* in Q13 */
  304.   buf[0] = sub( flsp[1], (PI04+8192) );           /* 8192:1.0(Q13) */
  306.   for ( i = 1 ; i < M-1 ; i++ ) {
  307.     tmp = sub( flsp[i+1], flsp[i-1] );
  308.     buf[i] = sub( tmp, 8192 );
  309.   }
  311.   buf[M-1] = sub( (PI92-8192), flsp[M-2] );
  313.   /* */
  314.   for ( i = 0 ; i < M ; i++ ) {
  315.     if ( buf[i] > 0 ){
  316.       wegt[i] = 2048;                    /* 2048:1.0(Q11) */
  317.     }
  318.     else {
  319.       L_acc = L_mult( buf[i], buf[i] );           /* L_acc in Q27 */
  320.       tmp = extract_h( L_shl( L_acc, 2 ) );       /* tmp in Q13 */
  322.       L_acc = L_mult( tmp, CONST10 );             /* L_acc in Q25 */
  323.       tmp = extract_h( L_shl( L_acc, 2 ) );       /* tmp in Q11 */
  325.       wegt[i] = add( tmp, 2048 );                 /* wegt in Q11 */
  326.     }
  327.   }
  329.   /* */
  330.   L_acc = L_mult( wegt[4], CONST12 );             /* L_acc in Q26 */
  331.   wegt[4] = extract_h( L_shl( L_acc, 1 ) );       /* wegt in Q11 */
  333.   L_acc = L_mult( wegt[5], CONST12 );             /* L_acc in Q26 */
  334.   wegt[5] = extract_h( L_shl( L_acc, 1 ) );       /* wegt in Q11 */
  336.   /* wegt: Q11 -> normalized */
  337.   tmp = 0;
  338.   for ( i = 0; i < M; i++ ) {
  339.     if ( sub(wegt[i], tmp) > 0 ) {
  340.       tmp = wegt[i];
  341.     }
  342.   }
  344.   sft = norm_s(tmp);
  345.   for ( i = 0; i < M; i++ ) {
  346.     wegt[i] = shl(wegt[i], sft);                  /* wegt in Q(11+sft) */
  347.   }
  349.   return;
  350. }