1135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/* /android/src/frameworks/base/libs/audioflinger/AudioShelvingFilter.cpp 2135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** 3135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** Copyright 2009, The Android Open Source Project 4135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** 5135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** Licensed under the Apache License, Version 2.0 (the "License"); 6135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** you may not use this file except in compliance with the License. 7135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** You may obtain a copy of the License at 8135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** 9135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** http://www.apache.org/licenses/LICENSE-2.0 10135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** 11135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** Unless required by applicable law or agreed to in writing, software 12135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** distributed under the License is distributed on an "AS IS" BASIS, 13135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 14135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** See the License for the specific language governing permissions and 15135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent** limitations under the License. 16135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent*/ 17135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 18135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "AudioShelvingFilter.h" 19135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "AudioCommon.h" 20135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "EffectsMath.h" 21135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 22135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include <new> 23135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include <assert.h> 24f6b1678f8f508b447155a81b44e214475ab634a8Glenn Kasten#include <cutils/compiler.h> 25135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 26135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentnamespace android { 27135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Format of the coefficient tables: 28135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// kCoefTable[freq][gain][coef] 29135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// freq - cutoff frequency, in octaves below Nyquist,from -10 to -6 in low 30135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// shelf, -2 to 0 in high shelf. 31135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// gain - gain, in millibel, starting at -9600, jumps of 1024, to 4736 millibel. 32135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// coef - 0: b0 33135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 1: b1 34135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 2: b2 35135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 3: -a1 36135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 4: -a2 37135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const size_t kHiInDims[2] = {3, 15}; 38135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const audio_coef_t kHiCoefTable[3*15*5] = { 39135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "AudioHighShelfFilterCoef.inl" 40135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 41135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const size_t kLoInDims[2] = {5, 15}; 42135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const audio_coef_t kLoCoefTable[5*15*5] = { 43135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "AudioLowShelfFilterCoef.inl" 44135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 45135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 46135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric LaurentAudioCoefInterpolator AudioShelvingFilter::mHiCoefInterp(2, kHiInDims, 5, (const audio_coef_t*) kHiCoefTable); 47135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric LaurentAudioCoefInterpolator AudioShelvingFilter::mLoCoefInterp(2, kLoInDims, 5, (const audio_coef_t*) kLoCoefTable); 48135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 49135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric LaurentAudioShelvingFilter::AudioShelvingFilter(ShelfType type, int nChannels, 50135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int sampleRate) 51ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent : mType(type), 52ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent mBiquad(nChannels, sampleRate) { 53135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent configure(nChannels, sampleRate); 54135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 55135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 56135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentvoid AudioShelvingFilter::configure(int nChannels, int sampleRate) { 57135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mNiquistFreq = sampleRate * 500; 58135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mFrequencyFactor = ((1ull) << 42) / mNiquistFreq; 59135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mBiquad.configure(nChannels, sampleRate); 60135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent setFrequency(mNominalFrequency); 61135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent commit(true); 62135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 63135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 64135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentvoid AudioShelvingFilter::reset() { 65135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent setGain(0); 66135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent setFrequency(mType == kLowShelf ? 0 : mNiquistFreq); 67135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent commit(true); 68135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 69135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 70135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentvoid AudioShelvingFilter::setFrequency(uint32_t millihertz) { 71135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mNominalFrequency = millihertz; 72f6b1678f8f508b447155a81b44e214475ab634a8Glenn Kasten if (CC_UNLIKELY(millihertz > mNiquistFreq / 2)) { 73135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent millihertz = mNiquistFreq / 2; 74135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 75135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint32_t normFreq = static_cast<uint32_t>( 76135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent (static_cast<uint64_t>(millihertz) * mFrequencyFactor) >> 10); 77135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint32_t log2minFreq = (mType == kLowShelf ? (32-10) : (32-2)); 78f6b1678f8f508b447155a81b44e214475ab634a8Glenn Kasten if (CC_LIKELY(normFreq > (1U << log2minFreq))) { 79135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mFrequency = (Effects_log2(normFreq) - (log2minFreq << 15)) << (FREQ_PRECISION_BITS - 15); 80135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 81135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mFrequency = 0; 82135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 83135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 84135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 85135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentvoid AudioShelvingFilter::setGain(int32_t millibel) { 86135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mGain = millibel + 9600; 87135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 88135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 89135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentvoid AudioShelvingFilter::commit(bool immediate) { 90135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent audio_coef_t coefs[5]; 91135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int intCoord[2] = { 92135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mFrequency >> FREQ_PRECISION_BITS, 93135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mGain >> GAIN_PRECISION_BITS 94135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent }; 95135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint32_t fracCoord[2] = { 96135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mFrequency << (32 - FREQ_PRECISION_BITS), 97135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent static_cast<uint32_t>(mGain) << (32 - GAIN_PRECISION_BITS) 98135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent }; 99135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (mType == kHighShelf) { 100135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mHiCoefInterp.getCoef(intCoord, fracCoord, coefs); 101135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 102135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mLoCoefInterp.getCoef(intCoord, fracCoord, coefs); 103135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 104135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent mBiquad.setCoefs(coefs, immediate); 105135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 106135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 107135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 108