1a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* ------------------------------------------------------------------ 2a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Copyright (C) 1998-2009 PacketVideo 3a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * 4a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Licensed under the Apache License, Version 2.0 (the "License"); 5a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * you may not use this file except in compliance with the License. 6a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * You may obtain a copy of the License at 7a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * 8a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * http://www.apache.org/licenses/LICENSE-2.0 9a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * 10a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * Unless required by applicable law or agreed to in writing, software 11a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * distributed under the License is distributed on an "AS IS" BASIS, 12a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either 13a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * express or implied. 14a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * See the License for the specific language governing permissions 15a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * and limitations under the License. 16a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber * ------------------------------------------------------------------- 17a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber */ 18a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/**************************************************************************************** 19a30d40083856cb4edd225faf8b488fab156e5976Andreas HuberPortions of this file are derived from the following 3GPP standard: 20a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 21a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 3GPP TS 26.173 22a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber ANSI-C code for the Adaptive Multi-Rate - Wideband (AMR-WB) speech codec 23a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Available from http://www.3gpp.org 24a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 25a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber(C) 2007, 3GPP Organizational Partners (ARIB, ATIS, CCSA, ETSI, TTA, TTC) 26a30d40083856cb4edd225faf8b488fab156e5976Andreas HuberPermission to distribute, modify and use this file under the standard license 27a30d40083856cb4edd225faf8b488fab156e5976Andreas Huberterms listed above has been obtained from the copyright holder. 28a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber****************************************************************************************/ 29a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* 30a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 31a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 32a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 33a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 34a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Filename: highpass_400Hz_at_12k8.cpp 35a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 36a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Date: 05/08/2004 37a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 38a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 39a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REVISION HISTORY 40a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 41a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 42a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Description: 43a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 44a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 45a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber INPUT AND OUTPUT DEFINITIONS 46a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 47a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 signal[], input signal / output is divided by 16 48a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 lg, lenght of signal 49a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 mem[] filter memory [6] 50a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 51a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 52a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 53a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber FUNCTION DESCRIPTION 54a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 55a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 2nd order high pass filter with cut off frequency at 400 Hz. 56a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Designed with cheby2 function in MATLAB. 57a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Optimized for fixed-point to get the following frequency response: 58a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 59a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber frequency: 0Hz 100Hz 200Hz 300Hz 400Hz 630Hz 1.5kHz 3kHz 60a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber dB loss: -infdB -30dB -20dB -10dB -3dB +6dB +1dB 0dB 61a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 62a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber Algorithm: 63a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 64a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber y[i] = b[0]*x[i] + b[1]*x[i-1] + b[2]*x[i-2] 65a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber + a[1]*y[i-1] + a[2]*y[i-2]; 66a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 67a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 b[3] = {3660, -7320, 3660}; in Q12 68a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 a[3] = {4096, 7320, -3540}; in Q12 69a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 70a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber float --> b[3] = {0.893554687, -1.787109375, 0.893554687}; 71a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber a[3] = {1.000000000, 1.787109375, -0.864257812}; 72a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 73a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 74a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 75a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REQUIREMENTS 76a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 77a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 78a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 79a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber REFERENCES 80a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 81a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 82a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber PSEUDO-CODE 83a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 84a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber------------------------------------------------------------------------------ 85a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber*/ 86a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 87a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 88a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 89a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; INCLUDES 90a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 91a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 92a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pv_amr_wb_type_defs.h" 93a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_basic_op.h" 94a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwb_math_op.h" 95a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber#include "pvamrwbdecoder_acelp.h" 96a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 97a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 98a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; MACROS 99a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Define module specific macros here 100a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 101a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 102a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 103a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 104a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; DEFINES 105a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Include all pre-processor statements here. Include conditional 106a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; compile variables also. 107a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 108a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 109a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 110a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; LOCAL FUNCTION DEFINITIONS 111a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Function Prototype declaration 112a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 113a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 114a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 115a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; LOCAL STORE/BUFFER/POINTER DEFINITIONS 116a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Variable declaration - defined here and used outside this module 117a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 118a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 119a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 120a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; EXTERNAL FUNCTION REFERENCES 121a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Declare functions defined elsewhere and referenced in this module 122a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 123a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 124a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 125a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES 126a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; Declare variables used in this module but defined elsewhere 127a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 128a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 129a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 130a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; FUNCTION CODE 131a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 132a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/* Initialization of static values */ 133a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 134a30d40083856cb4edd225faf8b488fab156e5976Andreas Hubervoid highpass_400Hz_at_12k8_init(int16 mem[]) 135a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 136a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber pv_memset((void *)mem, 0, 6*sizeof(*mem)); 137a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber} 138a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 139a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber/*---------------------------------------------------------------------------- 140a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber; FUNCTION CODE 141a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber----------------------------------------------------------------------------*/ 142a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 143a30d40083856cb4edd225faf8b488fab156e5976Andreas Hubervoid highpass_400Hz_at_12k8( 144a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 signal[], /* input signal / output is divided by 16 */ 145a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 lg, /* lenght of signal */ 146a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 mem[] /* filter memory [6] */ 147a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber) 148a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber{ 149a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 i, x2; 150a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int16 y2_hi, y2_lo, y1_hi, y1_lo, x0, x1; 151a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int32 L_tmp1; 152a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber int32 L_tmp2; 153a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 154a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber y2_hi = mem[0]; 155a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber y2_lo = mem[1]; 156a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber y1_hi = mem[2]; 157a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber y1_lo = mem[3]; 158a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber x0 = mem[4]; 159a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber x1 = mem[5]; 160a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 161a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber for (i = 0; i < lg; i++) 162a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber { 163a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 164a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* y[i] = b[0]*x[i] + b[1]*x[i-1] + b[0]*x[i-2] */ 165a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* + a[0]*y[i-1] + a[1] * y[i-2]; */ 166a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 167a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber L_tmp1 = fxp_mac_16by16(y1_lo, 29280, 8192L); 168a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber L_tmp2 = fxp_mul_16by16(y1_hi, 29280); 169a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber L_tmp1 = fxp_mac_16by16(y2_lo, -14160, L_tmp1); 170a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber L_tmp2 = fxp_mac_16by16(y2_hi, -14160, L_tmp2); 171a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber x2 = x1; 172a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber x1 = x0; 173a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber x0 = signal[i]; 174a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber L_tmp2 = fxp_mac_16by16(x2, 915, L_tmp2); 175a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber L_tmp2 = fxp_mac_16by16(x1, -1830, L_tmp2); 176a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber L_tmp2 = fxp_mac_16by16(x0, 915, L_tmp2); 177a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 178a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber L_tmp1 = (L_tmp1 >> 13) + (L_tmp2 << 2); /* coeff Q12 --> Q13 */ 179a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 180a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber y2_hi = y1_hi; 181a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber y2_lo = y1_lo; 182a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber /* signal is divided by 16 to avoid overflow in energy computation */ 183a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber signal[i] = (int16)((L_tmp1 + 0x00008000) >> 16); 184a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 185a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber y1_hi = (int16)(L_tmp1 >> 16); 186a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber y1_lo = (int16)((L_tmp1 - (y1_hi << 16)) >> 1); 187a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 188a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 189a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber } 190a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 191a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 192a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber mem[0] = y2_hi; 193a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber mem[1] = y2_lo; 194a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber mem[2] = y1_hi; 195a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber mem[3] = y1_lo; 196a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber mem[4] = x0; 197a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber mem[5] = x1; 198a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 199a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber} 200a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 201a30d40083856cb4edd225faf8b488fab156e5976Andreas Huber 202