1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
|
/*
** Copyright 2003-2010, VisualOn, Inc.
**
** Licensed under the Apache License, Version 2.0 (the "License");
** you may not use this file except in compliance with the License.
** You may obtain a copy of the License at
**
** http://www.apache.org/licenses/LICENSE-2.0
**
** Unless required by applicable law or agreed to in writing, software
** distributed under the License is distributed on an "AS IS" BASIS,
** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
** See the License for the specific language governing permissions and
** limitations under the License.
*/
/***********************************************************************
* File: hp400.c *
* *
* Description: *
* 2nd order high pass filter with cut off frequency at 400 Hz. *
* Designed with cheby2 function in MATLAB. *
* Optimized for fixed-point to get the following frequency response: *
* *
* frequency: 0Hz 100Hz 200Hz 300Hz 400Hz 630Hz 1.5kHz 3kHz *
* dB loss: -infdB -30dB -20dB -10dB -3dB +6dB +1dB 0dB *
* *
* 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] = {3660, -7320, 3660}; in Q12 *
* Word16 a[3] = {4096, 7320, -3540}; in Q12 *
* *
* float --> b[3] = {0.893554687, -1.787109375, 0.893554687}; *
* a[3] = {1.000000000, 1.787109375, -0.864257812}; *
* *
************************************************************************/
#include "typedef.h"
#include "basic_op.h"
#include "oper_32b.h"
#include "acelp.h"
/* filter coefficients */
static Word16 b[3] = {915, -1830, 915}; /* Q12 (/4) */
static Word16 a[3] = {16384, 29280, -14160}; /* Q12 (x4) */
/* Initialization of static values */
void Init_HP400_12k8(Word16 mem[])
{
Set_zero(mem, 6);
}
void HP400_12k8(
Word16 signal[], /* input signal / output is divided by 16 */
Word16 lg, /* lenght of signal */
Word16 mem[] /* filter memory [6] */
)
{
Word16 x2;
Word16 y2_hi, y2_lo, y1_hi, y1_lo, x0, x1;
Word32 L_tmp;
Word32 num;
y2_hi = *mem++;
y2_lo = *mem++;
y1_hi = *mem++;
y1_lo = *mem++;
x0 = *mem++;
x1 = *mem;
num = (Word32)lg;
do
{
x2 = x1;
x1 = x0;
x0 = *signal;
/* 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]; */
L_tmp = 8192L; /* rounding to maximise precision */
L_tmp += y1_lo * a[1];
L_tmp += y2_lo * a[2];
L_tmp = L_tmp >> 14;
L_tmp += (y1_hi * a[1] + y2_hi * a[2] + (x0 + x2)* b[0] + x1 * b[1]) << 1;
L_tmp <<= 1; /* coeff Q12 --> Q13 */
y2_hi = y1_hi;
y2_lo = y1_lo;
y1_hi = (Word16)(L_tmp>>16);
y1_lo = (Word16)((L_tmp & 0xffff)>>1);
/* signal is divided by 16 to avoid overflow in energy computation */
*signal++ = (L_tmp + 0x8000) >> 16;
}while(--num !=0);
*mem-- = x1;
*mem-- = x0;
*mem-- = y1_lo;
*mem-- = y1_hi;
*mem-- = y2_lo;
*mem = y2_hi;
return;
}
|
