14f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* ------------------------------------------------------------------ 24f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Copyright (C) 1998-2009 PacketVideo 34f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 44f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Licensed under the Apache License, Version 2.0 (the "License"); 54f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * you may not use this file except in compliance with the License. 64f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * You may obtain a copy of the License at 74f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 84f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * http://www.apache.org/licenses/LICENSE-2.0 94f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * 104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * Unless required by applicable law or agreed to in writing, software 114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * distributed under the License is distributed on an "AS IS" BASIS, 124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either 134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * express or implied. 144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * See the License for the specific language governing permissions 154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * and limitations under the License. 164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber * ------------------------------------------------------------------- 174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber */ 184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/**************************************************************************************** 194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas HuberPortions of this file are derived from the following 3GPP standard: 204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 3GPP TS 26.173 224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber ANSI-C code for the Adaptive Multi-Rate - Wideband (AMR-WB) speech codec 234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Available from http://www.3gpp.org 244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber(C) 2007, 3GPP Organizational Partners (ARIB, ATIS, CCSA, ETSI, TTA, TTC) 264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas HuberPermission to distribute, modify and use this file under the standard license 274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huberterms listed above has been obtained from the copyright holder. 284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber****************************************************************************************/ 294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* 304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Filename: highpass_400Hz_at_12k8.cpp 354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Date: 05/08/2004 374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber REVISION HISTORY 404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Description: 434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber INPUT AND OUTPUT DEFINITIONS 464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 signal[], input signal / output is divided by 16 484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 lg, lenght of signal 494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 mem[] filter memory [6] 504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber FUNCTION DESCRIPTION 544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2nd order high pass filter with cut off frequency at 400 Hz. 564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Designed with cheby2 function in MATLAB. 574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Optimized for fixed-point to get the following frequency response: 584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber frequency: 0Hz 100Hz 200Hz 300Hz 400Hz 630Hz 1.5kHz 3kHz 604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber dB loss: -infdB -30dB -20dB -10dB -3dB +6dB +1dB 0dB 614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber Algorithm: 634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber y[i] = b[0]*x[i] + b[1]*x[i-1] + b[2]*x[i-2] 654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber + a[1]*y[i-1] + a[2]*y[i-2]; 664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 b[3] = {3660, -7320, 3660}; in Q12 684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 a[3] = {4096, 7320, -3540}; in Q12 694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber float --> b[3] = {0.893554687, -1.787109375, 0.893554687}; 714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber a[3] = {1.000000000, 1.787109375, -0.864257812}; 724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber REQUIREMENTS 764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber REFERENCES 804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber PSEUDO-CODE 834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber------------------------------------------------------------------------------ 854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber*/ 864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; INCLUDES 904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pv_amr_wb_type_defs.h" 934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_basic_op.h" 944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwb_math_op.h" 954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber#include "pvamrwbdecoder_acelp.h" 964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; MACROS 994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Define module specific macros here 1004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1024f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1034f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1044f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; DEFINES 1054f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Include all pre-processor statements here. Include conditional 1064f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; compile variables also. 1074f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1084f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1094f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1104f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; LOCAL FUNCTION DEFINITIONS 1114f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Function Prototype declaration 1124f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1134f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1144f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1154f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; LOCAL STORE/BUFFER/POINTER DEFINITIONS 1164f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Variable declaration - defined here and used outside this module 1174f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1184f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1194f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1204f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; EXTERNAL FUNCTION REFERENCES 1214f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Declare functions defined elsewhere and referenced in this module 1224f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1234f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1244f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1254f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES 1264f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; Declare variables used in this module but defined elsewhere 1274f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1284f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1294f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1304f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 1314f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1324f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/* Initialization of static values */ 1334f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1344f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid highpass_400Hz_at_12k8_init(int16 mem[]) 1354f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 1364f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber pv_memset((void *)mem, 0, 6*sizeof(*mem)); 1374f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 1384f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1394f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber/*---------------------------------------------------------------------------- 1404f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber; FUNCTION CODE 1414f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber----------------------------------------------------------------------------*/ 1424f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1434f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Hubervoid highpass_400Hz_at_12k8( 1444f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 signal[], /* input signal / output is divided by 16 */ 1454f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 lg, /* lenght of signal */ 1464f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 mem[] /* filter memory [6] */ 1474f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber) 1484f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber{ 1494f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 i, x2; 1504f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int16 y2_hi, y2_lo, y1_hi, y1_lo, x0, x1; 1514f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_tmp1; 1524f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber int32 L_tmp2; 1534f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1544f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber y2_hi = mem[0]; 1554f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber y2_lo = mem[1]; 1564f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber y1_hi = mem[2]; 1574f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber y1_lo = mem[3]; 1584f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber x0 = mem[4]; 1594f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber x1 = mem[5]; 1604f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1614f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber for (i = 0; i < lg; i++) 1624f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber { 1634f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1644f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* y[i] = b[0]*x[i] + b[1]*x[i-1] + b[0]*x[i-2] */ 1654f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* + a[0]*y[i-1] + a[1] * y[i-2]; */ 1664f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1674f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp1 = fxp_mac_16by16(y1_lo, 29280, 8192L); 1684f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp2 = fxp_mul_16by16(y1_hi, 29280); 1694f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp1 = fxp_mac_16by16(y2_lo, -14160, L_tmp1); 1704f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp2 = fxp_mac_16by16(y2_hi, -14160, L_tmp2); 1714f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber x2 = x1; 1724f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber x1 = x0; 1734f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber x0 = signal[i]; 1744f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp2 = fxp_mac_16by16(x2, 915, L_tmp2); 1754f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp2 = fxp_mac_16by16(x1, -1830, L_tmp2); 1764f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp2 = fxp_mac_16by16(x0, 915, L_tmp2); 1774f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1784f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber L_tmp1 = (L_tmp1 >> 13) + (L_tmp2 << 2); /* coeff Q12 --> Q13 */ 1794f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1804f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber y2_hi = y1_hi; 1814f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber y2_lo = y1_lo; 1824f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber /* signal is divided by 16 to avoid overflow in energy computation */ 1834f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber signal[i] = (int16)((L_tmp1 + 0x00008000) >> 16); 1844f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1854f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber y1_hi = (int16)(L_tmp1 >> 16); 1864f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber y1_lo = (int16)((L_tmp1 - (y1_hi << 16)) >> 1); 1874f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1884f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1894f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber } 1904f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1914f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1924f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mem[0] = y2_hi; 1934f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mem[1] = y2_lo; 1944f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mem[2] = y1_hi; 1954f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mem[3] = y1_lo; 1964f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mem[4] = x0; 1974f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber mem[5] = x1; 1984f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 1994f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber} 2004f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 2014f1efc098cb5791c3e9f483f2af84aef70d2d0a0Andreas Huber 202