12c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* 22c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * Copyright (C) 2004-2010 NXP Software 32c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * Copyright (C) 2010 The Android Open Source Project 42c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * 52c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * Licensed under the Apache License, Version 2.0 (the "License"); 62c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * you may not use this file except in compliance with the License. 72c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * You may obtain a copy of the License at 82c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * 92c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * http://www.apache.org/licenses/LICENSE-2.0 102c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * 112c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * Unless required by applicable law or agreed to in writing, software 122c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * distributed under the License is distributed on an "AS IS" BASIS, 132c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 142c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * See the License for the specific language governing permissions and 152c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent * limitations under the License. 162c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent */ 172c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 182c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#include "LVM_Types.h" 192c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#include "Filter.h" 202c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#include "LVM_Macros.h" 212c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 222c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/************************************************************************************/ 232c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 242c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* Defines and Tables for 2*Pi/Fs */ 252c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 262c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/************************************************************************************/ 272c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 282c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#define LVVDL_2PiBy_8000 1727108826 /* In Q41 format */ 292c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#define LVVDL_2PiBy_11025 1253230894 /* In Q41 format */ 302c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#define LVVDL_2PiBy_12000 1151405884 /* In Q41 format */ 312c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 322c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#define LVVDL_2PiByFs_SHIFT1 12 /* Qformat shift for 8kHz, 11.025kHz and 12kHz i.e. 12=41-29 */ 332c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#define LVVDL_2PiByFs_SHIFT2 13 /* Qformat shift for 16kHz, 22.050kHz and 24kHz i.e. 13=42-29 */ 342c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent#define LVVDL_2PiByFs_SHIFT3 14 /* Qformat shift for 32kHz, 44.1kHz and 48kHz i.e. 14=43-29 */ 352c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 362c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurentconst LVM_INT32 LVVDL_2PiOnFsTable[] = {LVVDL_2PiBy_8000 , /* 8kHz in Q41, 16kHz in Q42, 32kHz in Q43 */ 372c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVVDL_2PiBy_11025, /* 11025 Hz in Q41, 22050Hz in Q42, 44100 Hz in Q43*/ 382c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVVDL_2PiBy_12000}; /* 12kHz in Q41, 24kHz in Q42, 48kHz in Q43 */ 392c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 402c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 412c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurentconst LVM_INT32 LVVDL_2PiOnFsShiftTable[]={LVVDL_2PiByFs_SHIFT1 , /* 8kHz, 11025Hz, 12kHz */ 422c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVVDL_2PiByFs_SHIFT2, /* 16kHz, 22050Hz, 24kHz*/ 432c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVVDL_2PiByFs_SHIFT3}; /* 32kHz, 44100Hz, 48kHz */ 442c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 452c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/*-------------------------------------------------------------------------*/ 462c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* FUNCTION: */ 472c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* LVM_GetOmega */ 482c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 492c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* LVM_INT32 LVM_GetOmega(LVM_UINT16 Fc, */ 502c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* LVM_Fs_en Fs) */ 512c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 522c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* DESCRIPTION: */ 532c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* This function calculates the value of w using Fc and Fs */ 542c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 552c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* PARAMETERS: */ 562c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* */ 572c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* LVM_UINT16 Fc The corner frequency in Hz Q16.0 format */ 582c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* LVM_Fs_en Fs The SampleRate */ 592c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* RETURNS: */ 602c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/* w=2*pi*Fc/Fs in Q2.29 format */ 612c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent/*-------------------------------------------------------------------------*/ 622c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 632c8e5cab3faa6d360e222b7a6c40a80083d021acEric LaurentLVM_INT32 LVM_GetOmega(LVM_UINT16 Fc, 642c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_Fs_en Fs) 652c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent{ 662c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent LVM_INT32 w; 672c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent MUL32x32INTO32((LVM_INT32)Fc,LVVDL_2PiOnFsTable[Fs%3],w,LVVDL_2PiOnFsShiftTable[Fs/3]) 682c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent return w; 692c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent} 702c8e5cab3faa6d360e222b7a6c40a80083d021acEric Laurent 71