frameworks/base/media/libstagefright/codecs/amrwb/src/voice_factor.cpp

   1 /* ------------------------------------------------------------------
   2  * Copyright (C) 1998-2009 PacketVideo
   3  *
   4  * Licensed under the Apache License, Version 2.0 (the "License");
   5  * you may not use this file except in compliance with the License.
   6  * You may obtain a copy of the License at
   7  *
   8  *      http://www.apache.org/licenses/LICENSE-2.0
   9  *
  10  * Unless required by applicable law or agreed to in writing, software
  11  * distributed under the License is distributed on an "AS IS" BASIS,
  12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either
  13  * express or implied.
  14  * See the License for the specific language governing permissions
  15  * and limitations under the License.
  16  * -------------------------------------------------------------------
  17  */
  18 /****************************************************************************************
  19 Portions of this file are derived from the following 3GPP standard:
  20
  21     3GPP TS 26.173
  22     ANSI-C code for the Adaptive Multi-Rate - Wideband (AMR-WB) speech codec
  23     Available from http://www.3gpp.org
  24
  25 (C) 2007, 3GPP Organizational Partners (ARIB, ATIS, CCSA, ETSI, TTA, TTC)
  26 Permission to distribute, modify and use this file under the standard license
  27 terms listed above has been obtained from the copyright holder.
  28 ****************************************************************************************/
  29 /*
  30 ------------------------------------------------------------------------------
  31
  32
  33
  34  Filename: voice_factor.cpp
  35
  36      Date: 05/08/2007
  37
  38 ------------------------------------------------------------------------------
  39  REVISION HISTORY
  40
  41
  42  Description:
  43
  44 ------------------------------------------------------------------------------
  45  INPUT AND OUTPUT DEFINITIONS
  46
  47      int16 exc[],        (i) Q_exc : pitch excitation
  48      int16 Q_exc,        (i)       : exc format
  49      int16 gain_pit,     (i) Q14   : gain of pitch
  50      int16 code[],       (i) Q9    : Fixed codebook excitation
  51      int16 gain_code,    (i) Q0    : gain of code
  52      int16 L_subfr       (i)       : subframe length
  53
  54 ------------------------------------------------------------------------------
  55  FUNCTION DESCRIPTION
  56
  57     Find the voicing factor (1=voice to -1=unvoiced).
  58
  59 ------------------------------------------------------------------------------
  60  REQUIREMENTS
  61
  62
  63 ------------------------------------------------------------------------------
  64  REFERENCES
  65
  66 ------------------------------------------------------------------------------
  67  PSEUDO-CODE
  68
  69 ------------------------------------------------------------------------------
  70 */
  71
  72
  73 /*----------------------------------------------------------------------------
  74 ; INCLUDES
  75 ----------------------------------------------------------------------------*/
  76
  77 #include "pv_amr_wb_type_defs.h"
  78 #include "pvamrwbdecoder_basic_op.h"
  79 #include "pvamrwb_math_op.h"
  80 #include "pvamrwbdecoder_acelp.h"
  81
  82 /*----------------------------------------------------------------------------
  83 ; MACROS
  84 ; Define module specific macros here
  85 ----------------------------------------------------------------------------*/
  86
  87
  88 /*----------------------------------------------------------------------------
  89 ; DEFINES
  90 ; Include all pre-processor statements here. Include conditional
  91 ; compile variables also.
  92 ----------------------------------------------------------------------------*/
  93
  94 /*----------------------------------------------------------------------------
  95 ; LOCAL FUNCTION DEFINITIONS
  96 ; Function Prototype declaration
  97 ----------------------------------------------------------------------------*/
  98
  99 /*----------------------------------------------------------------------------
 100 ; LOCAL STORE/BUFFER/POINTER DEFINITIONS
 101 ; Variable declaration - defined here and used outside this module
 102 ----------------------------------------------------------------------------*/
 103
 104 /*----------------------------------------------------------------------------
 105 ; EXTERNAL FUNCTION REFERENCES
 106 ; Declare functions defined elsewhere and referenced in this module
 107 ----------------------------------------------------------------------------*/
 108
 109 /*----------------------------------------------------------------------------
 110 ; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES
 111 ; Declare variables used in this module but defined elsewhere
 112 ----------------------------------------------------------------------------*/
 113
 114 /*----------------------------------------------------------------------------
 115 ; FUNCTION CODE
 116 ----------------------------------------------------------------------------*/
 117
 118 int16 voice_factor(    /* (o) Q15   : factor (-1=unvoiced to 1=voiced) */
 119     int16 exc[],      /* (i) Q_exc : pitch excitation                 */
 120     int16 Q_exc,      /* (i)       : exc format                       */
 121     int16 gain_pit,   /* (i) Q14   : gain of pitch                    */
 122     int16 code[],     /* (i) Q9    : Fixed codebook excitation        */
 123     int16 gain_code,  /* (i) Q0    : gain of code                     */
 124     int16 L_subfr     /* (i)       : subframe length                  */
 125 )
 126 {
 127     int16 i, tmp, exp, ener1, exp1, ener2, exp2;
 128     int32 L_tmp;
 129
 130     ener1 = extract_h(Dot_product12(exc, exc, L_subfr, &exp1));
 131     exp1 = sub_int16(exp1, Q_exc << 1);
 132     L_tmp = mul_16by16_to_int32(gain_pit, gain_pit);
 133     exp = normalize_amr_wb(L_tmp);
 134
 135     tmp = (int16)((L_tmp << exp) >> 16);
 136     ener1 = mult_int16(ener1, tmp);
 137     exp1 -= (exp + 10);        /* 10 -> gain_pit Q14 to Q9 */
 138
 139     ener2 = extract_h(Dot_product12(code, code, L_subfr, &exp2));
 140
 141     exp = norm_s(gain_code);
 142     tmp = shl_int16(gain_code, exp);
 143     tmp = mult_int16(tmp, tmp);
 144     ener2 = mult_int16(ener2, tmp);
 145     exp2 -= (exp << 1);
 146
 147     i = exp1 - exp2;
 148
 149
 150     if (i >= 0)
 151     {
 152         ener1 >>=  1;
 153         ener2 >>= (i + 1);
 154     }
 155     else
 156     {
 157         ener1 >>= (1 - i);
 158         ener2 >>= 1;
 159     }
 160
 161     tmp = ener1 - ener2;
 162     ener1 += ener2 + 1;
 163
 164
 165     if (tmp >= 0)
 166     {
 167         tmp = div_16by16(tmp, ener1);
 168     }
 169     else
 170     {
 171         tmp = negate_int16(div_16by16(negate_int16(tmp), ener1));
 172     }
 173
 174     return (tmp);
 175 }