shithub: sox

ref: dfaee703c5704ad796f152e45df0bd4c5d4106b7
dir: /amr-wb/agc2.c/

/*------------------------------------------------------------------------*
 *                         AGC2.C                                         *
 *------------------------------------------------------------------------*
 * Performs adaptive gain control                                         *
 *------------------------------------------------------------------------*/

#include <stdio.h>
#include <stdlib.h>

#include "cnst.h"
#include "acelp.h"
#include "typedef.h"
#include "basic_op.h"
#include "count.h"
#include "math_op.h"

void agc2(
     Word16 * sig_in,                      /* (i)     : postfilter input signal  */
     Word16 * sig_out,                     /* (i/o)   : postfilter output signal */
     Word16 l_trm                          /* (i)     : subframe size            */
)
{

    Word16 i, exp;
    Word16 gain_in, gain_out, g0;
    Word32 s;

    Word16 temp;

    /* calculate gain_out with exponent */

    temp = shr(sig_out[0], 2);
    s = L_mult(temp, temp);
    for (i = 1; i < l_trm; i++)
    {
        temp = shr(sig_out[i], 2);
        s = L_mac(s, temp, temp);
    }

    test();
    if (s == 0)
    {
        return;
    }
    exp = sub(norm_l(s), 1);
    gain_out = round(L_shl(s, exp));

    /* calculate gain_in with exponent */

    temp = shr(sig_in[0], 2);
    s = L_mult(temp, temp);
    for (i = 1; i < l_trm; i++)
    {
        temp = shr(sig_in[i], 2);
        s = L_mac(s, temp, temp);
    }

    test();
    if (s == 0)
    {
        g0 = 0;
        move16();
    } else
    {
        i = norm_l(s);
        gain_in = round(L_shl(s, i));
        exp = sub(exp, i);

        /*---------------------------------------------------*
         *  g0 = sqrt(gain_in/gain_out);                     *
         *---------------------------------------------------*/

        s = L_deposit_l(div_s(gain_out, gain_in));
        s = L_shl(s, 7);                   /* s = gain_out / gain_in */
        s = L_shr(s, exp);                 /* add exponent */

        s = Isqrt(s);
        g0 = round(L_shl(s, 9));
    }
    /* sig_out(n) = gain(n) sig_out(n) */

    for (i = 0; i < l_trm; i++)
    {
        sig_out[i] = extract_h(L_shl(L_mult(sig_out[i], g0), 2));
        move16();
    }

    return;
}