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

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

语音压缩

开发平台：

C/C++

VAD.C：源码内容
  1. /*
  2. **
  4. ** File:        "vad.c"
  5. **
  6. ** Description:     Voice Activity Detection
  7. **
  8. ** Functions:       Init_Vad()
  9. **                  Vad()
  10. **
  11. **
  12. */
  13. /*
  14.     ITU-T G.723 Speech Coder   ANSI-C Source Code     Version 5.00
  15.     copyright (c) 1995, AudioCodes, DSP Group, France Telecom,
  16.     Universite de Sherbrooke.  All rights reserved.
  17. */
  19. #include <stdio.h>
  21. #include "typedef.h"
  22. #include "basop.h"
  23. #include "cst_lbc.h"
  24. #include "tab_lbc.h"
  25. #include "lsp.h"
  26. #include "vad.h"
  27. #include "coder.h"
  28. #include "lbccodec.h"
  30. VADSTATDEF  VadStat ;
  32. void    Init_Vad(void)
  33. {
  34.     int i ;
  35.     VadStat.Hcnt = 3 ;
  36.     VadStat.Vcnt = 0 ;
  37.     VadStat.Penr = 0x00000400L ;
  38.     VadStat.Nlev = 0x00000400L ;
  40.     VadStat.Aen = 0 ;
  42.     VadStat.Polp[0] = 1 ;
  43.     VadStat.Polp[1] = 1 ;
  44.     VadStat.Polp[2] = SubFrLen ;
  45.     VadStat.Polp[3] = SubFrLen ;
  47.     for(i=0; i < LpcOrder; i++) VadStat.NLpc[i] = 0;
  49. }
  51. Flag Comp_Vad( Word16 *Dpnt)
  52. {
  53.     int i,j ;
  55.     Word32  Acc0,Acc1 ;
  56.     Word16  Tm0, Tm1, Tm2 ;
  57.     Word16  Minp ;
  59.     Flag    VadState = 1 ;
  61.     static  Word16  ScfTab[11] = {
  62.          9170 ,
  63.          9170 ,
  64.          9170 ,
  65.          9170 ,
  66.         10289 ,
  67.         11544 ,
  68.         12953 ,
  69.         14533 ,
  70.         16306 ,
  71.         18296 ,
  72.         20529 ,
  73.     } ;
  75.     if ( !UseVx )
  76.         return VadState ;
  78.     /* Find Minimum pitch period */
  79.     Minp = PitchMax ;
  80.     for ( i = 0 ; i < 4 ; i ++ ) {
  81.         if ( Minp > VadStat.Polp[i] )
  82.             Minp = VadStat.Polp[i] ;
  83.     }
  85.     /* Check that all are multiplies of the minimum */
  86.     Tm2 = 0 ;
  87.     for ( i = 0 ; i < 4 ; i ++ ) {
  88.         Tm1 = Minp ;
  89.         for ( j = 0 ; j < 8 ; j ++ ) {
  90.             Tm0 = sub( Tm1, VadStat.Polp[i] ) ;
  91.             Tm0 = abs_s( Tm0 ) ;
  92.             if ( Tm0 <= 3 )
  93.                 Tm2 ++ ;
  94.             Tm1 = add( Tm1, Minp ) ;
  95.         }
  96.     }
  98.     /* Update adaptation enable counter if not periodic and not sine */
  99.     if ( (Tm2 == 4) || (CodStat.SinDet < 0) )
  100.         VadStat.Aen += 2 ;
  101.     else
  102.         VadStat.Aen -- ;
  104.     /* Clip it */
  105.     if ( VadStat.Aen > 6 )
  106.         VadStat.Aen = 6 ;
  107.     if ( VadStat.Aen < 0 )
  108.         VadStat.Aen = 0 ;
  110.     /* Inverse filter the data */
  111.     Acc1 = 0L ;
  112.     for ( i = SubFrLen ; i < Frame ; i ++ ) {
  114.         Acc0 = L_mult( Dpnt[i], 0x2000 ) ;
  115.         for ( j = 0 ; j < LpcOrder ; j ++ )
  116.             Acc0 = L_msu( Acc0, Dpnt[i-j-1], VadStat.NLpc[j] ) ;
  117.         Tm0 = round ( Acc0 ) ;
  118.         Acc1 = L_mac( Acc1, Tm0, Tm0 ) ;
  119.     }
  121.     /* Scale the rezidual energy */
  122.     Acc1 = L_mls( Acc1, (Word16) 2913 ) ;
  124.     /* Clip noise level in any case */
  125.     if ( VadStat.Nlev > VadStat.Penr ) {
  126.         Acc0 = L_sub( VadStat.Penr, L_shr( VadStat.Penr, 2 ) ) ;
  127.         VadStat.Nlev = L_add( Acc0, L_shr( VadStat.Nlev, 2 ) ) ;
  128.     }
  131.     /* Update the noise level, if adaptation is enabled */
  132.     if ( !VadStat.Aen ) {
  133.         VadStat.Nlev = L_add( VadStat.Nlev, L_shr( VadStat.Nlev, 5 ) ) ;
  134.     }
  135.     /* Decay Nlev by small amount */
  136.     else {
  137.         VadStat.Nlev = L_sub( VadStat.Nlev, L_shr( VadStat.Nlev,11 ) ) ;
  138.     }
  140.     /* Update previous energy */
  141.     VadStat.Penr = Acc1 ;
  143.     /* CLip Noise Level */
  144.     if ( VadStat.Nlev < 0x00000080L )
  145.         VadStat.Nlev = 0x00000080L ;
  146.     if ( VadStat.Nlev > 0x0001ffffL )
  147.         VadStat.Nlev = 0x0001ffffL ;
  149.     /* Compute the treshold */
  150.     Acc0 = L_shl( VadStat.Nlev, 13 ) ;
  151.     Tm0 = norm_l( Acc0 ) ;
  152.     Acc0 = L_shl( Acc0, Tm0 ) ;
  153.     Acc0 &= 0x3f000000L ;
  154.     Acc0 <<= 1 ;
  155.     Tm1 = extract_h( Acc0 ) ;
  156.     Acc0 = L_deposit_h( ScfTab[Tm0] ) ;
  157.     Acc0 = L_mac( Acc0, Tm1, ScfTab[Tm0-1] ) ;
  158.     Acc0 = L_msu( Acc0, Tm1, ScfTab[Tm0] ) ;
  159.     Tm1 = extract_h( Acc0 ) ;
  160.     Tm0 = extract_l( L_shr( VadStat.Nlev, 2 ) ) ;
  161.     Acc0 = L_mult( Tm0, Tm1 ) ;
  162.     Acc0 >>= 11 ;
  164.     /* Compare with the treshold */
  165.     if ( Acc0 > Acc1 )
  166.         VadState = 0 ;
  168.     /* Do the various counters */
  169.     if ( VadState ) {
  170.         VadStat.Vcnt ++ ;
  171.         VadStat.Hcnt ++ ;
  172.     }
  173.     else {
  174.         VadStat.Vcnt -- ;
  175.         if ( VadStat.Vcnt < 0 )
  176.             VadStat.Vcnt = 0 ;
  177.     }
  179.     if ( VadStat.Vcnt >= 2 ) {
  180.         VadStat.Hcnt = 6 ;
  181.         if ( VadStat.Vcnt >= 3 )
  182.             VadStat.Vcnt = 3 ;
  183.     }
  185.     if ( VadStat.Hcnt ) {
  186.         VadState = 1 ;
  187.         if ( VadStat.Vcnt == 0 )
  188.             VadStat.Hcnt -- ;
  189.     }
  191.     /* Update Periodicy detector */
  192.     VadStat.Polp[0] = VadStat.Polp[2] ;
  193.     VadStat.Polp[1] = VadStat.Polp[3] ;
  195.     return VadState ;
  196. }