ref: c78ac707b07a3c8dea4685274cb6f1b3ba1ea93f
dir: /amr-wb/hp50.c/
/*-----------------------------------------------------------------------*
* HP50.C *
*-----------------------------------------------------------------------*
* 2nd order high pass filter with cut off frequency at 31 Hz. *
* Designed with cheby2 function in MATLAB. *
* Optimized for fixed-point to get the following frequency response: *
* *
* frequency: 0Hz 14Hz 24Hz 31Hz 37Hz 41Hz 47Hz *
* dB loss: -infdB -15dB -6dB -3dB -1.5dB -1dB -0.5dB *
* *
* Algorithm: *
* *
* y[i] = b[0]*x[i] + b[1]*x[i-1] + b[2]*x[i-2] *
* + a[1]*y[i-1] + a[2]*y[i-2]; *
* *
* Word16 b[3] = {4053, -8106, 4053}; in Q12 *
* Word16 a[3] = {8192, 16211, -8021}; in Q12 *
* *
* float --> b[3] = {0.989501953, -1.979003906, 0.989501953}; *
* a[3] = {1.000000000, 1.978881836, -0.979125977}; *
*-----------------------------------------------------------------------*/
#include "typedef.h"
#include "basic_op.h"
#include "oper_32b.h"
#include "cnst.h"
#include "acelp.h"
#include "count.h"
/* filter coefficients */
static Word16 b[3] = {4053, -8106, 4053}; /* Q12 */
static Word16 a[3] = {8192, 16211, -8021}; /* Q12 (x2) */
/* Initialization of static values */
void Init_HP50_12k8(Word16 mem[])
{
Set_zero(mem, 6);
}
void HP50_12k8(
Word16 signal[], /* input/output signal */
Word16 lg, /* lenght of signal */
Word16 mem[] /* filter memory [6] */
)
{
Word16 i, x2;
Word16 y2_hi, y2_lo, y1_hi, y1_lo, x0, x1;
Word32 L_tmp;
y2_hi = mem[0]; move16();
y2_lo = mem[1]; move16();
y1_hi = mem[2]; move16();
y1_lo = mem[3]; move16();
x0 = mem[4]; move16();
x1 = mem[5]; move16();
for (i = 0; i < lg; i++)
{
x2 = x1; move16();
x1 = x0; move16();
x0 = signal[i]; move16();
/* y[i] = b[0]*x[i] + b[1]*x[i-1] + b140[2]*x[i-2] */
/* + a[1]*y[i-1] + a[2] * y[i-2]; */
move32();
L_tmp = 16384L; /* rounding to maximise precision */
L_tmp = L_mac(L_tmp, y1_lo, a[1]);
L_tmp = L_mac(L_tmp, y2_lo, a[2]);
L_tmp = L_shr(L_tmp, 15);
L_tmp = L_mac(L_tmp, y1_hi, a[1]);
L_tmp = L_mac(L_tmp, y2_hi, a[2]);
L_tmp = L_mac(L_tmp, x0, b[0]);
L_tmp = L_mac(L_tmp, x1, b[1]);
L_tmp = L_mac(L_tmp, x2, b[2]);
L_tmp = L_shl(L_tmp, 2); /* coeff Q12 --> Q14 */
y2_hi = y1_hi; move16();
y2_lo = y1_lo; move16();
L_Extract(L_tmp, &y1_hi, &y1_lo);
L_tmp = L_shl(L_tmp, 1); /* coeff Q14 --> Q15 with saturation */
signal[i] = round(L_tmp); move16();
}
mem[0] = y2_hi; move16();
mem[1] = y2_lo; move16();
mem[2] = y1_hi; move16();
mem[3] = y1_lo; move16();
mem[4] = x0; move16();
mem[5] = x1; move16();
return;
}