1a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* ------------------------------------------------------------------
2a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Copyright (C) 1998-2009 PacketVideo
3a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *
4a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Licensed under the Apache License, Version 2.0 (the "License");
5a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * you may not use this file except in compliance with the License.
6a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * You may obtain a copy of the License at
7a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *
8a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *      http://www.apache.org/licenses/LICENSE-2.0
9a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber *
10a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Unless required by applicable law or agreed to in writing, software
11a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * distributed under the License is distributed on an "AS IS" BASIS,
12a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either
13a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * express or implied.
14a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * See the License for the specific language governing permissions
15a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * and limitations under the License.
16a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * -------------------------------------------------------------------
17a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber */
18a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/****************************************************************************************
19a30d40083856cb4edd225faf8b488fab156e5976Andreas HuberPortions of this file are derived from the following 3GPP standard:
20a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
21a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    3GPP TS 26.073
22a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    ANSI-C code for the Adaptive Multi-Rate (AMR) speech codec
23a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    Available from http://www.3gpp.org
24a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
25a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber(C) 2004, 3GPP Organizational Partners (ARIB, ATIS, CCSA, ETSI, TTA, TTC)
26a30d40083856cb4edd225faf8b488fab156e5976Andreas HuberPermission to distribute, modify and use this file under the standard license
27a30d40083856cb4edd225faf8b488fab156e5976Andreas Huberterms listed above has been obtained from the copyright holder.
28a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber****************************************************************************************/
29a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*
30a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
31a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
32a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
33a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
34a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Pathname: ./audio/gsm-amr/c/src/ex_ctrl.c
35a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Funtions: ex_ctrl
36a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
37a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber     Date: 02/08/2002
38a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
39a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
40a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REVISION HISTORY
41a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
42a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description:  Replaced "int" and/or "char" with OSCL defined types.
43a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
44a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description:
45a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
46a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
47a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber*/
48a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
49a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*----------------------------------------------------------------------------
50a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; INCLUDES
51a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/
52a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "ex_ctrl.h"
53a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "typedef.h"
54a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "cnst.h"
55a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "copy.h"
56a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "set_zero.h"
57a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "gmed_n.h"
58a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "sqrt_l.h"
59a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "basic_op.h"
60a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*----------------------------------------------------------------------------
61a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; MACROS
62a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Define module specific macros here
63a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/
64a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
65a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*----------------------------------------------------------------------------
66a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; DEFINES
67a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Include all pre-processor statements here. Include conditional
68a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; compile variables also.
69a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/
70a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
71a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*----------------------------------------------------------------------------
72a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; LOCAL FUNCTION DEFINITIONS
73a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Function Prototype declaration
74a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/
75a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
76a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*----------------------------------------------------------------------------
77a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; LOCAL VARIABLE DEFINITIONS
78a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Variable declaration - defined here and used outside this module
79a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/
80a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
81a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*
82a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
83a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber FUNCTION NAME: ex_ctrl
84a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
85a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber INPUT AND OUTPUT DEFINITIONS
86a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
87a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Inputs:
88a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber excitation = pointer to current subframe excitation of type Word16
89a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber excEnergy = Exc. Energy, sqrt(totEx*totEx) of type Word16
90a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber exEnergyHist = pointer to history of subframe energies of type Word16
91a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber voicedHangover = # of fr. after last voiced fr  of type Word16
92a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber carefulFlag = restrict dynamic in scaling of type Word16
93a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow = pointer to overflow indicator
94a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
95a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Outputs:
96a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pOverflow = 1 if overflow exists in the math functions called by this function.
97a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
98a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Returns:
99a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    None
100a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
101a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Global Variables Used:
102a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    None
103a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
104a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Local Variables Needed:
105a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    None
106a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
107a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
108a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber FUNCTION DESCRIPTION
109a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
110a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Function    : Ex_ctrl
111a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Purpose     : Charaterice synthesis speech and detect background noise
112a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Returns     : background noise decision; 0 = no bgn, 1 = bgn
113a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
114a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
115a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REQUIREMENTS
116a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
117a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber None
118a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
119a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
120a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REFERENCES
121a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
122a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ex_ctrl.c, 3GPP TS 26.101 version 4.1.0 Release 4, June 2001
123a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
124a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
125a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber PSEUDO-CODE
126a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
127a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
128a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
129a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
130a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber RESOURCES USED [optional]
131a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
132a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber When the code is written for a specific target processor the
133a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber the resources used should be documented below.
134a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
135a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber HEAP MEMORY USED: x bytes
136a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
137a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber STACK MEMORY USED: x bytes
138a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
139a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber CLOCK CYCLES: (cycle count equation for this function) + (variable
140a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber                used to represent cycle count for each subroutine
141a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber                called)
142a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber     where: (cycle count variable) = cycle count for [subroutine
143a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber                                     name]
144a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
145a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
146a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber CAUTION [optional]
147a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber [State any special notes, constraints or cautions for users of this function]
148a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
149a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------
150a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber*/
151a30d40083856cb4edd225faf8b488fab156e5976Andreas HuberWord16 Ex_ctrl(Word16 excitation[],    /*i/o: Current subframe excitation   */
152a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber               Word16 excEnergy,      /* i : Exc. Energy, sqrt(totEx*totEx)*/
153a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber               Word16 exEnergyHist[], /* i : History of subframe energies  */
154a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber               Word16 voicedHangover, /* i : # of fr. after last voiced fr.*/
155a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber               Word16 prevBFI,        /* i : Set i previous BFI            */
156a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber               Word16 carefulFlag,    /* i : Restrict dymamic in scaling   */
157a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber               Flag   *pOverflow
158a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber              )
159a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{
160a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    Word16 i, exp;
161a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    Word16 testEnergy, scaleFactor, avgEnergy, prevEnergy;
162a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    Word32 t0;
163a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
164a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    /* get target level */
165a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    avgEnergy = gmed_n(exEnergyHist, 9);
166a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
167a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    prevEnergy = shr(add(exEnergyHist[7], exEnergyHist[8], pOverflow) , 1, pOverflow);
168a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
169a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    if (exEnergyHist[8] < prevEnergy)
170a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    {
171a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        prevEnergy = exEnergyHist[8];
172a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    }
173a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
174a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    /* upscaling to avoid too rapid energy rises  for some cases */
175a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    if ((excEnergy < avgEnergy) && (excEnergy > 5))
176a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    {
177a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        testEnergy = shl(prevEnergy, 2, pOverflow);  /* testEnergy = 4*prevEnergy; */
178a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
179a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        if ((voicedHangover < 7) || prevBFI != 0)
180a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        {
181a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber            /* testEnergy = 3*prevEnergy */
182a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber            testEnergy = sub(testEnergy, prevEnergy, pOverflow);
183a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        }
184a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
185a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        if (avgEnergy > testEnergy)
186a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        {
187a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber            avgEnergy = testEnergy;
188a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        }
189a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
190a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        /* scaleFactor=avgEnergy/excEnergy in Q0 (const 29 below)*/
191a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        exp = norm_s(excEnergy);
192a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        excEnergy = shl(excEnergy, exp, pOverflow);
193a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        excEnergy = div_s((Word16) 16383, excEnergy);
194a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        t0 = L_mult(avgEnergy, excEnergy, pOverflow);
195a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        t0 = L_shr(t0, sub(20, exp, pOverflow), pOverflow);
196a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        /* const=30 for t0 in Q0, 20 for Q10 */
197a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        if (t0 > 32767)
198a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        {
199a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber            t0 = 32767; /* saturate  */
200a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        }
201a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        scaleFactor = extract_l(t0);
202a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
203a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        /* test if scaleFactor > 3.0 */
204a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        if (carefulFlag != 0 && (scaleFactor > 3072))
205a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        {
206a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber            scaleFactor = 3072;
207a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        }
208a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
209a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        /* scale the excitation by scaleFactor */
210a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        for (i = 0; i < L_SUBFR; i++)
211a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        {
212a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber            t0 = L_mult(scaleFactor, excitation[i], pOverflow);
213a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber            t0 = L_shr(t0, 11, pOverflow);
214a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber            excitation[i] = extract_l(t0);
215a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber        }
216a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    }
217a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber
218a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber    return 0;
219a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber}
220