EffectEqualizer.cpp revision 17217ab46e12fbdaad9e1d7460c48937f76fa0e2
1135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/* 2135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Copyright (C) 2009 The Android Open Source Project 3135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 4135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Licensed under the Apache License, Version 2.0 (the "License"); 5135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * you may not use this file except in compliance with the License. 6135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * You may obtain a copy of the License at 7135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 8135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * http://www.apache.org/licenses/LICENSE-2.0 9135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 10135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Unless required by applicable law or agreed to in writing, software 11135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * distributed under the License is distributed on an "AS IS" BASIS, 12135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * See the License for the specific language governing permissions and 14135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * limitations under the License. 15135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 16135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 17135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#define LOG_TAG "Equalizer" 18135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#define ARRAY_SIZE(array) (sizeof array / sizeof array[0]) 19135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//#define LOG_NDEBUG 0 20135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include <cutils/log.h> 21135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include <assert.h> 22135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include <stdlib.h> 2317217ab46e12fbdaad9e1d7460c48937f76fa0e2Eric Laurent#include <string.h> 24135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include <new> 25135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "AudioEqualizer.h" 26135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "AudioBiquadFilter.h" 27135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "AudioFormatAdapter.h" 28135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include <media/EffectEqualizerApi.h> 29135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 30135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// effect_interface_t interface implementation for equalizer effect 31135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentextern "C" const struct effect_interface_s gEqualizerInterface; 32135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 33135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentnamespace android { 34135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentnamespace { 35135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 36135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Google Graphic Equalizer UUID: e25aa840-543b-11df-98a5-0002a5d5c51b 37135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst effect_descriptor_t gEqualizerDescriptor = { 38135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0x0bed4300, 0xddd6, 0x11db, 0x8f34, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, // type 39135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0xe25aa840, 0x543b, 0x11df, 0x98a5, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, // uuid 40135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_API_VERSION, 41135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent (EFFECT_FLAG_TYPE_INSERT | EFFECT_FLAG_INSERT_LAST), 42135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Graphic Equalizer", 43135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Google Inc.", 44135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 45135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int gEffectIndex; 46135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 47135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/////////////////// BEGIN EQ PRESETS /////////////////////////////////////////// 48135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst int kNumBands = 5; 49135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst uint32_t gFreqs[kNumBands] = { 50000, 125000, 900000, 3200000, 6300000 }; 50135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst uint32_t gBandwidths[kNumBands] = { 0, 3600, 3600, 2400, 0 }; 51135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 52135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst AudioEqualizer::BandConfig gBandsClassic[kNumBands] = { 53135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 300, gFreqs[0], gBandwidths[0] }, 54135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 400, gFreqs[1], gBandwidths[1] }, 55135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 0, gFreqs[2], gBandwidths[2] }, 56135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 200, gFreqs[3], gBandwidths[3] }, 57135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { -300, gFreqs[4], gBandwidths[4] } 58135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 59135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 60135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst AudioEqualizer::BandConfig gBandsJazz[kNumBands] = { 61135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { -600, gFreqs[0], gBandwidths[0] }, 62135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 200, gFreqs[1], gBandwidths[1] }, 63135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 400, gFreqs[2], gBandwidths[2] }, 64135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { -400, gFreqs[3], gBandwidths[3] }, 65135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { -600, gFreqs[4], gBandwidths[4] } 66135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 67135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 68135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst AudioEqualizer::BandConfig gBandsPop[kNumBands] = { 69135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 400, gFreqs[0], gBandwidths[0] }, 70135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { -400, gFreqs[1], gBandwidths[1] }, 71135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 300, gFreqs[2], gBandwidths[2] }, 72135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { -400, gFreqs[3], gBandwidths[3] }, 73135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 600, gFreqs[4], gBandwidths[4] } 74135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 75135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 76135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst AudioEqualizer::BandConfig gBandsRock[kNumBands] = { 77135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 700, gFreqs[0], gBandwidths[0] }, 78135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 400, gFreqs[1], gBandwidths[1] }, 79135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { -400, gFreqs[2], gBandwidths[2] }, 80135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 400, gFreqs[3], gBandwidths[3] }, 81135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { 200, gFreqs[4], gBandwidths[4] } 82135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 83135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 84135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst AudioEqualizer::PresetConfig gEqualizerPresets[] = { 85135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { "Classic", gBandsClassic }, 86135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { "Jazz", gBandsJazz }, 87135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { "Pop", gBandsPop }, 88135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent { "Rock", gBandsRock } 89135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 90135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 91135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/////////////////// END EQ PRESETS ///////////////////////////////////////////// 92135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 93135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const size_t kBufferSize = 32; 94135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 95135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurenttypedef AudioFormatAdapter<AudioEqualizer, kBufferSize> FormatAdapter; 96135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 97135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstruct EqualizerContext { 98135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent const struct effect_interface_s *itfe; 99135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent effect_config_t config; 100135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent FormatAdapter adapter; 101135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent AudioEqualizer * pEqualizer; 102135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 103135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 104135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 105135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//--- local function prototypes 106135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 107135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Equalizer_init(EqualizerContext *pContext); 108135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Equalizer_configure(EqualizerContext *pContext, effect_config_t *pConfig); 109135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Equalizer_getParameter(AudioEqualizer * pEqualizer, int32_t *pParam, size_t *pValueSize, void *pValue); 110135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Equalizer_setParameter(AudioEqualizer * pEqualizer, int32_t *pParam, void *pValue); 111135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 112135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 113135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 114135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//--- Effect Library Interface Implementation 115135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 116135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 117135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentextern "C" int EffectQueryNumberEffects(int *pNumEffects) { 118135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pNumEffects = 1; 119135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent gEffectIndex = 0; 120135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 121135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end EffectQueryNumberEffects */ 122135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 123135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentextern "C" int EffectQueryNext(effect_descriptor_t *pDescriptor) { 124135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pDescriptor == NULL) { 125135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 126135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 127135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (gEffectIndex++ > 0) { 128135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -ENOENT; 129135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 130135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent memcpy(pDescriptor, &gEqualizerDescriptor, sizeof(effect_descriptor_t)); 131135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 132135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end EffectQueryNext */ 133135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 134135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentextern "C" int EffectCreate(effect_uuid_t *uuid, 135135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent effect_interface_t *pInterface) { 136135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int ret; 137135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int i; 138135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 139135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("EffectLibCreateEffect start"); 140135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 141135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pInterface == NULL || uuid == NULL) { 142135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 143135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 144135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 145135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (memcmp(uuid, &gEqualizerDescriptor.uuid, sizeof(effect_uuid_t)) != 0) { 146135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 147135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 148135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 149135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EqualizerContext *pContext = new EqualizerContext; 150135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 151135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->itfe = &gEqualizerInterface; 152135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->pEqualizer = NULL; 153135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 154135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ret = Equalizer_init(pContext); 155135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (ret < 0) { 156135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGW("EffectLibCreateEffect() init failed"); 157135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent delete pContext; 158135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return ret; 159135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 160135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 161135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pInterface = (effect_interface_t)pContext; 162135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 163135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("EffectLibCreateEffect %p", pContext); 164135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 165135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 166135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 167135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end EffectCreate */ 168135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 169135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentextern "C" int EffectRelease(effect_interface_t interface) { 170135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EqualizerContext * pContext = (EqualizerContext *)interface; 171135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 172135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("EffectLibReleaseEffect %p", interface); 173135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pContext == NULL) { 174135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 175135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 176135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 177135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->pEqualizer->free(); 178135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent delete pContext; 179135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 180135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 181135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end EffectRelease */ 182135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 183135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 184135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 185135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//--- local functions 186135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 187135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 188135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#define CHECK_ARG(cond) { \ 189135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (!(cond)) { \ 190135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Invalid argument: "#cond); \ 191135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; \ 192135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } \ 193135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 194135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 195135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 196135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Equalizer_configure() 197135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 198135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Purpose: Set input and output audio configuration. 199135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 200135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Inputs: 201135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// pContext: effect engine context 202135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// pConfig: pointer to effect_config_t structure holding input and output 203135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// configuration parameters 204135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 205135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Outputs: 206135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 207135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 208135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 209135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Equalizer_configure(EqualizerContext *pContext, effect_config_t *pConfig) 210135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent{ 211135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_configure start"); 212135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 213135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent CHECK_ARG(pContext != NULL); 214135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent CHECK_ARG(pConfig != NULL); 215135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 216135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent CHECK_ARG(pConfig->inputCfg.samplingRate == pConfig->outputCfg.samplingRate); 217135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent CHECK_ARG(pConfig->inputCfg.channels == pConfig->outputCfg.channels); 218135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent CHECK_ARG(pConfig->inputCfg.format == pConfig->outputCfg.format); 219135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent CHECK_ARG((pConfig->inputCfg.channels == CHANNEL_MONO) || (pConfig->inputCfg.channels == CHANNEL_STEREO)); 220135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent CHECK_ARG(pConfig->outputCfg.accessMode == EFFECT_BUFFER_ACCESS_WRITE 221135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent || pConfig->outputCfg.accessMode == EFFECT_BUFFER_ACCESS_ACCUMULATE); 222135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent CHECK_ARG(pConfig->inputCfg.format == PCM_FORMAT_S7_24 223135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent || pConfig->inputCfg.format == PCM_FORMAT_S15); 224135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 225135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int channelCount; 226135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pConfig->inputCfg.channels == CHANNEL_MONO) { 227135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent channelCount = 1; 228135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 229135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent channelCount = 2; 230135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 231135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent CHECK_ARG(channelCount <= AudioBiquadFilter::MAX_CHANNELS); 232135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 233135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->pEqualizer->configure(channelCount, 234135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pConfig->inputCfg.samplingRate); 235135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 236135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->adapter.configure(*pContext->pEqualizer, channelCount, 237135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pConfig->inputCfg.format, 238135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pConfig->outputCfg.accessMode); 239135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 240135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 241135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} // end Equalizer_configure 242135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 243135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 244135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 245135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Equalizer_init() 246135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 247135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Purpose: Initialize engine with default configuration and creates 248135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// AudioEqualizer instance. 249135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 250135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Inputs: 251135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// pContext: effect engine context 252135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 253135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Outputs: 254135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 255135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 256135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 257135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Equalizer_init(EqualizerContext *pContext) 258135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent{ 259135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int status; 260135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 261135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_init start"); 262135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 263135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent CHECK_ARG(pContext != NULL); 264135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 265135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pContext->pEqualizer != NULL) { 266135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->pEqualizer->free(); 267135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 268135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 269135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ; 270135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.inputCfg.channels = CHANNEL_STEREO; 271135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.inputCfg.format = PCM_FORMAT_S15; 272135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.inputCfg.samplingRate = 44100; 273135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.inputCfg.bufferProvider.getBuffer = NULL; 274135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.inputCfg.bufferProvider.releaseBuffer = NULL; 275135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.inputCfg.bufferProvider.cookie = NULL; 276135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.inputCfg.mask = EFFECT_CONFIG_ALL; 277135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_ACCUMULATE; 278135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.outputCfg.channels = CHANNEL_STEREO; 279135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.outputCfg.format = PCM_FORMAT_S15; 280135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.outputCfg.samplingRate = 44100; 281135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.outputCfg.bufferProvider.getBuffer = NULL; 282135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.outputCfg.bufferProvider.releaseBuffer = NULL; 283135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.outputCfg.bufferProvider.cookie = NULL; 284135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->config.outputCfg.mask = EFFECT_CONFIG_ALL; 285135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 286135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->pEqualizer = AudioEqualizer::CreateInstance( 287135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent NULL, 288135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent kNumBands, 289135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent AudioBiquadFilter::MAX_CHANNELS, 290135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 44100, 291135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent gEqualizerPresets, 292135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ARRAY_SIZE(gEqualizerPresets)); 293135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 294135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (int i = 0; i < kNumBands; ++i) { 295135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->pEqualizer->setFrequency(i, gFreqs[i]); 296135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->pEqualizer->setBandwidth(i, gBandwidths[i]); 297135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 298135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 299135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->pEqualizer->enable(true); 300135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 301135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Equalizer_configure(pContext, &pContext->config); 302135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 303135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 304135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} // end Equalizer_init 305135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 306135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 307135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 308135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Equalizer_getParameter() 309135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 310135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Purpose: 311135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Get a Equalizer parameter 312135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 313135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Inputs: 314135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// pEqualizer - handle to instance data 315135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// pParam - pointer to parameter 316135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// pValue - pointer to variable to hold retrieved value 317135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// pValueSize - pointer to value size: maximum size as input 318135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 319135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Outputs: 320135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// *pValue updated with parameter value 321135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// *pValueSize updated with actual value size 322135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 323135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 324135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Side Effects: 325135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 326135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 327135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 328135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Equalizer_getParameter(AudioEqualizer * pEqualizer, int32_t *pParam, size_t *pValueSize, void *pValue) 329135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent{ 330135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int status = 0; 331135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t param = *pParam++; 332135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t param2; 333135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent char *name; 334135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 335135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (param) { 336135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_NUM_BANDS: 337135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_CUR_PRESET: 338135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_GET_NUM_OF_PRESETS: 339135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (*pValueSize < sizeof(int16_t)) { 340135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 341135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 342135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValueSize = sizeof(int16_t); 343135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 344135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 345135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_LEVEL_RANGE: 346135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_BAND_FREQ_RANGE: 347135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (*pValueSize < 2 * sizeof(int32_t)) { 348135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 349135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 350135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValueSize = 2 * sizeof(int32_t); 351135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 352135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_BAND_LEVEL: 353135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_GET_BAND: 354135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_CENTER_FREQ: 355135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (*pValueSize < sizeof(int32_t)) { 356135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 357135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 358135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValueSize = sizeof(int32_t); 359135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 360135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 361135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_GET_PRESET_NAME: 362135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 363135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 364135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 365135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 366135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 367135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 368135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (param) { 369135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_NUM_BANDS: 370135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int16_t *)pValue = kNumBands; 371135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_getParameter() EQ_PARAM_NUM_BANDS %d", *(int16_t *)pValue); 372135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 373135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 374135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_LEVEL_RANGE: 375135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int32_t *)pValue = -9600; 376135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *((int32_t *)pValue + 1) = 4800; 377135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_getParameter() EQ_PARAM_LEVEL_RANGE min %d, max %d", *(int32_t *)pValue, *((int32_t *)pValue + 1)); 378135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 379135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 380135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_BAND_LEVEL: 381135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent param2 = *pParam; 382135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param2 >= kNumBands) { 383135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent status = -EINVAL; 384135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 385135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 386135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int32_t *)pValue = pEqualizer->getGain(param2); 387135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_getParameter() EQ_PARAM_BAND_LEVEL band %d, level %d", param2, *(int32_t *)pValue); 388135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 389135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 390135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_CENTER_FREQ: 391135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent param2 = *pParam; 392135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param2 >= kNumBands) { 393135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent status = -EINVAL; 394135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 395135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 396135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int32_t *)pValue = pEqualizer->getFrequency(param2); 397135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_getParameter() EQ_PARAM_CENTER_FREQ band %d, frequency %d", param2, *(int32_t *)pValue); 398135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 399135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 400135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_BAND_FREQ_RANGE: 401135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent param2 = *pParam; 402135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param2 >= kNumBands) { 403135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent status = -EINVAL; 404135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 405135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 406135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pEqualizer->getBandRange(param2, *(uint32_t *)pValue, *((uint32_t *)pValue + 1)); 407135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_getParameter() EQ_PARAM_BAND_FREQ_RANGE band %d, min %d, max %d", param2, *(int32_t *)pValue, *((int32_t *)pValue + 1)); 408135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 409135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 410135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_GET_BAND: 411135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent param2 = *pParam; 412135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int32_t *)pValue = pEqualizer->getMostRelevantBand(param2); 413135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_getParameter() EQ_PARAM_GET_BAND frequency %d, band %d", param2, *(int32_t *)pValue); 414135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 415135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 416135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_CUR_PRESET: 417135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int16_t *)pValue = pEqualizer->getPreset(); 418135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_getParameter() EQ_PARAM_CUR_PRESET %d", *(int32_t *)pValue); 419135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 420135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 421135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_GET_NUM_OF_PRESETS: 422135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int16_t *)pValue = pEqualizer->getNumPresets(); 423135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_getParameter() EQ_PARAM_GET_NUM_OF_PRESETS %d", *(int16_t *)pValue); 424135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 425135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 426135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_GET_PRESET_NAME: 427135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent param2 = *pParam; 428135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param2 >= pEqualizer->getNumPresets()) { 429135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent status = -EINVAL; 430135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 431135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 432135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent name = (char *)pValue; 433135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent strncpy(name, pEqualizer->getPresetName(param2), *pValueSize - 1); 434135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent name[*pValueSize - 1] = 0; 435135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValueSize = strlen(name) + 1; 436135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_getParameter() EQ_PARAM_GET_PRESET_NAME preset %d, name %s len %d", param2, gEqualizerPresets[param2].name, *pValueSize); 437135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 438135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 439135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 440135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_getParameter() invalid param %d", param); 441135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent status = -EINVAL; 442135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 443135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 444135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 445135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return status; 446135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} // end Equalizer_getParameter 447135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 448135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 449135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 450135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Equalizer_setParameter() 451135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 452135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Purpose: 453135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Set a Equalizer parameter 454135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 455135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Inputs: 456135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// pEqualizer - handle to instance data 457135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// pParam - pointer to parameter 458135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// pValue - pointer to value 459135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 460135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Outputs: 461135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 462135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 463135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Side Effects: 464135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 465135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//---------------------------------------------------------------------------- 466135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 467135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Equalizer_setParameter (AudioEqualizer * pEqualizer, int32_t *pParam, void *pValue) 468135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent{ 469135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int status = 0; 470135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t preset; 471135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t band; 472135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t level; 473135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t param = *pParam++; 474135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 475135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 476135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (param) { 477135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_CUR_PRESET: 478135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent preset = *(int16_t *)pValue; 479135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 480135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("setParameter() EQ_PARAM_CUR_PRESET %d", preset); 481135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (preset >= pEqualizer->getNumPresets()) { 482135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent status = -EINVAL; 483135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 484135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 485135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pEqualizer->setPreset(preset); 486135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pEqualizer->commit(true); 487135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 488135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EQ_PARAM_BAND_LEVEL: 489135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent band = *pParam; 490135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent level = *(int32_t *)pValue; 491135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("setParameter() EQ_PARAM_BAND_LEVEL band %d, level %d", band, level); 492135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (band >= kNumBands) { 493135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent status = -EINVAL; 494135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 495135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 496135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pEqualizer->setGain(band, level); 497135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pEqualizer->commit(true); 498135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 499135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 500135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("setParameter() invalid param %d", param); 501135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 502135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 503135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 504135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return status; 505135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} // end Equalizer_setParameter 506135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 507135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} // namespace 508135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} // namespace 509135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 510135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 511135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 512135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent//--- Effect Control Interface Implementation 513135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 514135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 515135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentextern "C" int Equalizer_process(effect_interface_t self, audio_buffer_t *inBuffer, audio_buffer_t *outBuffer) 516135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent{ 517135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent android::EqualizerContext * pContext = (android::EqualizerContext *) self; 518135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 519135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pContext == NULL) { 520135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 521135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 522135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (inBuffer == NULL || inBuffer->raw == NULL || 523135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent outBuffer == NULL || outBuffer->raw == NULL || 524135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent inBuffer->frameCount != outBuffer->frameCount) { 525135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 526135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 527135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 528135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pContext->adapter.process(inBuffer->raw, outBuffer->raw, outBuffer->frameCount); 529135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 530135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} // end Equalizer_process 531135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 532135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentextern "C" int Equalizer_command(effect_interface_t self, int cmdCode, int cmdSize, 533135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent void *pCmdData, int *replySize, void *pReplyData) { 534135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 535135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent android::EqualizerContext * pContext = (android::EqualizerContext *) self; 536135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int retsize; 537135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 538135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pContext == NULL) { 539135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 540135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 541135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 542135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent android::AudioEqualizer * pEqualizer = pContext->pEqualizer; 543135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 544135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_command command %d cmdSize %d",cmdCode, cmdSize); 545135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 546135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (cmdCode) { 547135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_INIT: 548135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReplyData == NULL || *replySize != sizeof(int)) { 549135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 550135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 551135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int *) pReplyData = Equalizer_init(pContext); 552135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 553135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_CONFIGURE: 554135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pCmdData == NULL || cmdSize != sizeof(effect_config_t) 555135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent || pReplyData == NULL || *replySize != sizeof(int)) { 556135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 557135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 558135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int *) pReplyData = Equalizer_configure(pContext, 559135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent (effect_config_t *) pCmdData); 560135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 561135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_RESET: 562135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Equalizer_configure(pContext, &pContext->config); 563135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 564135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_GET_PARAM: { 565135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pCmdData == NULL || cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t)) || 566135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReplyData == NULL || *replySize < (int) (sizeof(effect_param_t) + sizeof(int32_t))) { 567135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 568135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 569135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent effect_param_t *p = (effect_param_t *)pCmdData; 570135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent memcpy(pReplyData, pCmdData, sizeof(effect_param_t) + p->psize); 571135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent p = (effect_param_t *)pReplyData; 572135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int voffset = ((p->psize - 1) / sizeof(int32_t) + 1) * sizeof(int32_t); 573135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent p->status = android::Equalizer_getParameter(pEqualizer, (int32_t *)p->data, &p->vsize, 574135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent p->data + voffset); 575135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *replySize = sizeof(effect_param_t) + voffset + p->vsize; 576135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_command EFFECT_CMD_GET_PARAM *pCmdData %d, *replySize %d, *pReplyData %08x %08x", 577135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int32_t *)((char *)pCmdData + sizeof(effect_param_t)), *replySize, 578135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int32_t *)((char *)pReplyData + sizeof(effect_param_t) + voffset), 579135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int32_t *)((char *)pReplyData + sizeof(effect_param_t) + voffset + sizeof(int32_t))); 580135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 581135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } break; 582135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_SET_PARAM: { 583135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Equalizer_command EFFECT_CMD_SET_PARAM cmdSize %d pCmdData %p, *replySize %d, pReplyData %p", cmdSize, pCmdData, *replySize, pReplyData); 584135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pCmdData == NULL || cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t)) || 585135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReplyData == NULL || *replySize != sizeof(int32_t)) { 586135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 587135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 588135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent effect_param_t *p = (effect_param_t *) pCmdData; 589135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int *)pReplyData = android::Equalizer_setParameter(pEqualizer, (int32_t *)p->data, 590135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent p->data + p->psize); 591135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } break; 592135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 593135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGW("Equalizer_command invalid command %d",cmdCode); 594135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 595135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 596135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 597135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 598135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 599135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 600135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// effect_interface_t interface implementation for equalizer effect 601135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst struct effect_interface_s gEqualizerInterface = { 602135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Equalizer_process, 603135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Equalizer_command 604135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 605135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 606135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 607