1/*
2 * Copyright (C) 2004-2010 NXP Software
3 * Copyright (C) 2010 The Android Open Source Project
4 *
5 * Licensed under the Apache License, Version 2.0 (the "License");
6 * you may not use this file except in compliance with the License.
7 * You may obtain a copy of the License at
8 *
9 *      http://www.apache.org/licenses/LICENSE-2.0
10 *
11 * Unless required by applicable law or agreed to in writing, software
12 * distributed under the License is distributed on an "AS IS" BASIS,
13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14 * See the License for the specific language governing permissions and
15 * limitations under the License.
16 */
17
18#include "BIQUAD.h"
19#include "DC_2I_D16_TRC_WRA_01_Private.h"
20#include "LVM_Macros.h"
21
22void DC_2I_D16_TRC_WRA_01( Biquad_Instance_t       *pInstance,
23                           LVM_INT16               *pDataIn,
24                           LVM_INT16               *pDataOut,
25                           LVM_INT16               NrSamples)
26    {
27        LVM_INT32 LeftDC,RightDC;
28        LVM_INT32 Diff;
29        LVM_INT32 j;
30        PFilter_State pBiquadState = (PFilter_State) pInstance;
31
32        LeftDC  =   pBiquadState->LeftDC;
33        RightDC =   pBiquadState->RightDC;
34        for(j=NrSamples-1;j>=0;j--)
35        {
36            /* Subtract DC an saturate */
37            Diff=*(pDataIn++)-(LeftDC>>16);
38            if (Diff > 32767) {
39                Diff = 32767; }
40            else if (Diff < -32768) {
41                Diff = -32768; }
42            *(pDataOut++)=(LVM_INT16)Diff;
43            if (Diff < 0) {
44                LeftDC -= DC_D16_STEP; }
45            else {
46                LeftDC += DC_D16_STEP; }
47
48
49            /* Subtract DC an saturate */
50            Diff=*(pDataIn++)-(RightDC>>16);
51            if (Diff > 32767) {
52                Diff = 32767; }
53            else if (Diff < -32768) {
54                Diff = -32768; }
55            *(pDataOut++)=(LVM_INT16)Diff;
56            if (Diff < 0) {
57                RightDC -= DC_D16_STEP; }
58            else {
59                RightDC += DC_D16_STEP; }
60
61        }
62        pBiquadState->LeftDC    =   LeftDC;
63        pBiquadState->RightDC   =   RightDC;
64
65
66    }
67
68