EffectReverb.c revision 23e1de74359f4bb1763aef0adfebe073122b032c
1135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/* 2135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Copyright (C) 2008 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 "EffectReverb" 18e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent//#define LOG_NDEBUG 0 19135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include <cutils/log.h> 20be916aa1267e2e6b1c148f51d11bcbbc79cb864cEric Laurent#include <stdlib.h> 21be916aa1267e2e6b1c148f51d11bcbbc79cb864cEric Laurent#include <string.h> 22135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include <stdbool.h> 23135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "EffectReverb.h" 24135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "EffectsMath.h" 25135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 26135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// effect_interface_t interface implementation for reverb effect 27135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst struct effect_interface_s gReverbInterface = { 28135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Reverb_Process, 29135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Reverb_Command 30135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 31135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 32135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Google auxiliary environmental reverb UUID: 1f0ae2e0-4ef7-11df-bc09-0002a5d5c51b 33135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const effect_descriptor_t gAuxEnvReverbDescriptor = { 34135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0xc2e5d5f0, 0x94bd, 0x4763, 0x9cac, {0x4e, 0x23, 0x4d, 0x06, 0x83, 0x9e}}, 35135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0x1f0ae2e0, 0x4ef7, 0x11df, 0xbc09, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, 36135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_API_VERSION, 37ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent // flags other than EFFECT_FLAG_TYPE_AUXILIARY set for test purpose 38ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent EFFECT_FLAG_TYPE_AUXILIARY | EFFECT_FLAG_DEVICE_IND | EFFECT_FLAG_AUDIO_MODE_IND, 39ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent 0, // TODO 40ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent 33, 41135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Aux Environmental Reverb", 42135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Google Inc." 43135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 44135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 45135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Google insert environmental reverb UUID: aa476040-6342-11df-91a4-0002a5d5c51b 46135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const effect_descriptor_t gInsertEnvReverbDescriptor = { 47135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0xc2e5d5f0, 0x94bd, 0x4763, 0x9cac, {0x4e, 0x23, 0x4d, 0x06, 0x83, 0x9e}}, 48135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0xaa476040, 0x6342, 0x11df, 0x91a4, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, 49135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_API_VERSION, 50135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_FLAG_TYPE_INSERT | EFFECT_FLAG_INSERT_FIRST, 51ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent 0, // TODO 52ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent 33, 53135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Insert Environmental reverb", 54135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Google Inc." 55135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 56135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 57135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Google auxiliary preset reverb UUID: 63909320-53a6-11df-bdbd-0002a5d5c51b 58135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const effect_descriptor_t gAuxPresetReverbDescriptor = { 59cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent {0x47382d60, 0xddd8, 0x11db, 0xbf3a, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, 60135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0x63909320, 0x53a6, 0x11df, 0xbdbd, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, 61135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_API_VERSION, 62135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_FLAG_TYPE_AUXILIARY, 63ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent 0, // TODO 64ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent 33, 65135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Aux Preset Reverb", 66135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Google Inc." 67135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 68135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 69135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Google insert preset reverb UUID: d93dc6a0-6342-11df-b128-0002a5d5c51b 70135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const effect_descriptor_t gInsertPresetReverbDescriptor = { 71cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent {0x47382d60, 0xddd8, 0x11db, 0xbf3a, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, 72135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0xd93dc6a0, 0x6342, 0x11df, 0xb128, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, 73135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_API_VERSION, 74135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_FLAG_TYPE_INSERT | EFFECT_FLAG_INSERT_FIRST, 75ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent 0, // TODO 76ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent 33, 77135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Insert Preset Reverb", 78135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Google Inc." 79135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 80135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 81135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// gDescriptors contains pointers to all defined effect descriptor in this library 82135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const effect_descriptor_t * const gDescriptors[] = { 83135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent &gAuxEnvReverbDescriptor, 84135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent &gInsertEnvReverbDescriptor, 85135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent &gAuxPresetReverbDescriptor, 86ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent &gInsertPresetReverbDescriptor 87135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 88135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 89135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 90135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Effect API implementation 91135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *--------------------------------------------------------------------------*/ 92135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 93135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*--- Effect Library Interface Implementation ---*/ 94135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 95be916aa1267e2e6b1c148f51d11bcbbc79cb864cEric Laurentint EffectQueryNumberEffects(uint32_t *pNumEffects) { 96ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent *pNumEffects = sizeof(gDescriptors) / sizeof(const effect_descriptor_t *); 97135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 98135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 99135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 100ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurentint EffectQueryEffect(uint32_t index, effect_descriptor_t *pDescriptor) { 101135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pDescriptor == NULL) { 102135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 103135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 104ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent if (index >= sizeof(gDescriptors) / sizeof(const effect_descriptor_t *)) { 105ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent return -EINVAL; 106135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 107ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent memcpy(pDescriptor, gDescriptors[index], 108135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent sizeof(effect_descriptor_t)); 109135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 110135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 111135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 112135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint EffectCreate(effect_uuid_t *uuid, 113ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent int32_t sessionId, 114ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent int32_t ioId, 115135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent effect_interface_t *pInterface) { 116135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int ret; 117135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int i; 118135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_module_t *module; 119135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent const effect_descriptor_t *desc; 120135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int aux = 0; 121135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int preset = 0; 122135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 123135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("EffectLibCreateEffect start"); 124135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 125135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pInterface == NULL || uuid == NULL) { 126135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 127135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 128135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 129135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; gDescriptors[i] != NULL; i++) { 130135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent desc = gDescriptors[i]; 131135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (memcmp(uuid, &desc->uuid, sizeof(effect_uuid_t)) 132135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent == 0) { 133135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 134135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 135135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 136135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 137135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (gDescriptors[i] == NULL) { 138135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -ENOENT; 139135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 140135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 141135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent module = malloc(sizeof(reverb_module_t)); 142135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 143135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent module->itfe = &gReverbInterface; 144135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 145e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent module->context.mState = REVERB_STATE_UNINITIALIZED; 146e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent 147135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (memcmp(&desc->type, SL_IID_PRESETREVERB, sizeof(effect_uuid_t)) == 0) { 148135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent preset = 1; 149135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 150135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if ((desc->flags & EFFECT_FLAG_TYPE_MASK) == EFFECT_FLAG_TYPE_AUXILIARY) { 151135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent aux = 1; 152135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 153135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ret = Reverb_Init(module, aux, preset); 154135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (ret < 0) { 155135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGW("EffectLibCreateEffect() init failed"); 156135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent free(module); 157135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return ret; 158135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 159135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 160135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pInterface = (effect_interface_t) module; 161135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 162e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent module->context.mState = REVERB_STATE_INITIALIZED; 163e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent 164ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent LOGV("EffectLibCreateEffect %p ,size %d", module, sizeof(reverb_module_t)); 165135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 166135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 167135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 168135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 169135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint EffectRelease(effect_interface_t interface) { 170135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_module_t *pRvbModule = (reverb_module_t *)interface; 171135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 172135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("EffectLibReleaseEffect %p", interface); 173135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (interface == NULL) { 174135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 175135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 176135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 177e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent pRvbModule->context.mState = REVERB_STATE_UNINITIALIZED; 178e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent 179135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent free(pRvbModule); 180135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 181135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 182135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 183135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 184135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*--- Effect Control Interface Implementation ---*/ 185135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 186135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int Reverb_Process(effect_interface_t self, audio_buffer_t *inBuffer, audio_buffer_t *outBuffer) { 187135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_object_t *pReverb; 188135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t *pSrc, *pDst; 189135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_module_t *pRvbModule = (reverb_module_t *)self; 190135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 191135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pRvbModule == NULL) { 192135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 193135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 194135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 195135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (inBuffer == NULL || inBuffer->raw == NULL || 196135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent outBuffer == NULL || outBuffer->raw == NULL || 197135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent inBuffer->frameCount != outBuffer->frameCount) { 198135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 199135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 200135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 201135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb = (reverb_object_t*) &pRvbModule->context; 202135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 203e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent if (pReverb->mState == REVERB_STATE_UNINITIALIZED) { 204e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent return -EINVAL; 205e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent } 206e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent if (pReverb->mState == REVERB_STATE_INITIALIZED) { 207e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent return -ENODATA; 208e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent } 209e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent 210135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //if bypassed or the preset forces the signal to be completely dry 211cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (pReverb->m_bBypass != 0) { 212ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent if (inBuffer->raw != outBuffer->raw) { 213ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent int16_t smp; 214ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent pSrc = inBuffer->s16; 215ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent pDst = outBuffer->s16; 216ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent size_t count = inBuffer->frameCount; 217ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent if (pRvbModule->config.inputCfg.channels == pRvbModule->config.outputCfg.channels) { 218ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent count *= 2; 219ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent while (count--) { 220ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent *pDst++ = *pSrc++; 221ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent } 222ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent } else { 223ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent while (count--) { 224ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent smp = *pSrc++; 225ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent *pDst++ = smp; 226ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent *pDst++ = smp; 227ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent } 228ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent } 229135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 230135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 231135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 232135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 233135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_nNextRoom != pReverb->m_nCurrentRoom) { 234135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ReverbUpdateRoom(pReverb, true); 235135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 236135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 237135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pSrc = inBuffer->s16; 238135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pDst = outBuffer->s16; 239135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent size_t numSamples = outBuffer->frameCount; 240135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent while (numSamples) { 241135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint32_t processedSamples; 242135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (numSamples > (uint32_t) pReverb->m_nUpdatePeriodInSamples) { 243135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent processedSamples = (uint32_t) pReverb->m_nUpdatePeriodInSamples; 244135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 245135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent processedSamples = numSamples; 246135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 247135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 248135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* increment update counter */ 249135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdateCounter += (int16_t) processedSamples; 250135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* check if update counter needs to be reset */ 251135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_nUpdateCounter >= pReverb->m_nUpdatePeriodInSamples) { 252135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* update interval has elapsed, so reset counter */ 253135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdateCounter -= pReverb->m_nUpdatePeriodInSamples; 254135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ReverbUpdateXfade(pReverb, pReverb->m_nUpdatePeriodInSamples); 255135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 256135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } /* end if m_nUpdateCounter >= update interval */ 257135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 258135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Reverb(pReverb, processedSamples, pDst, pSrc); 259135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 260135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent numSamples -= processedSamples; 261135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_Aux) { 262ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent pSrc += processedSamples; 263135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 264135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pSrc += processedSamples * NUM_OUTPUT_CHANNELS; 265135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 266ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent pDst += processedSamples * NUM_OUTPUT_CHANNELS; 267135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 268135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 269135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 270135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 271135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 272e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent 273135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int Reverb_Command(effect_interface_t self, int cmdCode, int cmdSize, 274135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent void *pCmdData, int *replySize, void *pReplyData) { 275135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_module_t *pRvbModule = (reverb_module_t *) self; 276135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_object_t *pReverb; 277135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int retsize; 278135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 279e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent if (pRvbModule == NULL || 280e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent pRvbModule->context.mState == REVERB_STATE_UNINITIALIZED) { 281135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 282135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 283135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 284135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb = (reverb_object_t*) &pRvbModule->context; 285135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 286135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Command command %d cmdSize %d",cmdCode, cmdSize); 287135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 288135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (cmdCode) { 289135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_INIT: 290135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReplyData == NULL || *replySize != sizeof(int)) { 291135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 292135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 293135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int *) pReplyData = Reverb_Init(pRvbModule, pReverb->m_Aux, pReverb->m_Preset); 294e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent if (*(int *) pReplyData == 0) { 295e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent pRvbModule->context.mState = REVERB_STATE_INITIALIZED; 296e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent } 297135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 298135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_CONFIGURE: 299135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pCmdData == NULL || cmdSize != sizeof(effect_config_t) 300135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent || pReplyData == NULL || *replySize != sizeof(int)) { 301135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 302135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 303135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int *) pReplyData = Reverb_Configure(pRvbModule, 304135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent (effect_config_t *)pCmdData, false); 305135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 306135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_RESET: 307135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Reverb_Reset(pReverb, false); 308135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 309135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_GET_PARAM: 310135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Command EFFECT_CMD_GET_PARAM pCmdData %p, *replySize %d, pReplyData: %p",pCmdData, *replySize, pReplyData); 311135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 312135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pCmdData == NULL || cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t)) || 313135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReplyData == NULL || *replySize < (int) sizeof(effect_param_t)) { 314135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 315135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 316135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent effect_param_t *rep = (effect_param_t *) pReplyData; 317135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent memcpy(pReplyData, pCmdData, sizeof(effect_param_t) + sizeof(int32_t)); 318135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Command EFFECT_CMD_GET_PARAM param %d, replySize %d",*(int32_t *)rep->data, rep->vsize); 319135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent rep->status = Reverb_getParameter(pReverb, *(int32_t *)rep->data, &rep->vsize, 320135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent rep->data + sizeof(int32_t)); 321135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *replySize = sizeof(effect_param_t) + sizeof(int32_t) + rep->vsize; 322135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 323135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_SET_PARAM: 324135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Command EFFECT_CMD_SET_PARAM cmdSize %d pCmdData %p, *replySize %d, pReplyData %p", 325135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent cmdSize, pCmdData, *replySize, pReplyData); 326135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pCmdData == NULL || (cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t))) 327135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent || pReplyData == NULL || *replySize != (int)sizeof(int32_t)) { 328135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 329135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 330135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent effect_param_t *cmd = (effect_param_t *) pCmdData; 331135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int *)pReplyData = Reverb_setParameter(pReverb, *(int32_t *)cmd->data, 332135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent cmd->vsize, cmd->data + sizeof(int32_t)); 333135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 334ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent case EFFECT_CMD_ENABLE: 335e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent if (pReplyData == NULL || *replySize != sizeof(int)) { 336e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent return -EINVAL; 337e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent } 338e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent if (pReverb->mState != REVERB_STATE_INITIALIZED) { 339e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent return -ENOSYS; 340e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent } 341e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent pReverb->mState = REVERB_STATE_ACTIVE; 342e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent LOGV("EFFECT_CMD_ENABLE() OK"); 343e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent *(int *)pReplyData = 0; 344e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent break; 345ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent case EFFECT_CMD_DISABLE: 346ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent if (pReplyData == NULL || *replySize != sizeof(int)) { 347ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent return -EINVAL; 348ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent } 349e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent if (pReverb->mState != REVERB_STATE_ACTIVE) { 350e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent return -ENOSYS; 351e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent } 352e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent pReverb->mState = REVERB_STATE_INITIALIZED; 353e44b1efb293f878d4af8e824a6b3d070167bf2d6Eric Laurent LOGV("EFFECT_CMD_DISABLE() OK"); 354ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent *(int *)pReplyData = 0; 355ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent break; 356ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent case EFFECT_CMD_SET_DEVICE: 357ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent if (pCmdData == NULL || cmdSize != (int)sizeof(uint32_t)) { 358ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent return -EINVAL; 359ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent } 360ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent LOGV("Reverb_Command EFFECT_CMD_SET_DEVICE: 0x%08x", *(uint32_t *)pCmdData); 361ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent break; 362ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent case EFFECT_CMD_SET_VOLUME: { 363ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent // audio output is always stereo => 2 channel volumes 364ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent if (pCmdData == NULL || cmdSize != (int)sizeof(uint32_t) * 2) { 365ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent return -EINVAL; 366ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent } 367ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent float left = (float)(*(uint32_t *)pCmdData) / (1 << 24); 368ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent float right = (float)(*((uint32_t *)pCmdData + 1)) / (1 << 24); 369ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent LOGV("Reverb_Command EFFECT_CMD_SET_VOLUME: left %f, right %f ", left, right); 370ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent break; 371ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent } 372ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent case EFFECT_CMD_SET_AUDIO_MODE: 373ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent if (pCmdData == NULL || cmdSize != (int)sizeof(uint32_t)) { 374ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent return -EINVAL; 375ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent } 376ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent LOGV("Reverb_Command EFFECT_CMD_SET_AUDIO_MODE: %d", *(uint32_t *)pCmdData); 377ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent break; 378135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 379135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGW("Reverb_Command invalid command %d",cmdCode); 380135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 381135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 382135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 383135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 384135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 385135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 386135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 387135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 388135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb internal functions 389135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *--------------------------------------------------------------------------*/ 390135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 391135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 392135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb_Init() 393135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 394135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 395135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Initialize reverb context and apply default parameters 396135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 397135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 398135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pRvbModule - pointer to reverb effect module 399135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * aux - indicates if the reverb is used as auxiliary (1) or insert (0) 400135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * preset - indicates if the reverb is used in preset (1) or environmental (0) mode 401135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 402135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 403135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 404135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 405135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 406135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 407135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 408135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 409135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Reverb_Init(reverb_module_t *pRvbModule, int aux, int preset) { 410135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int ret; 411135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 412135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Init module %p, aux: %d, preset: %d", pRvbModule,aux, preset); 413135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 414135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent memset(&pRvbModule->context, 0, sizeof(reverb_object_t)); 415135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 416135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->context.m_Aux = (uint16_t)aux; 417135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->context.m_Preset = (uint16_t)preset; 418135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 419135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.samplingRate = 44100; 420135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (aux) { 421135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.channels = CHANNEL_MONO; 422135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 423135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.channels = CHANNEL_STEREO; 424135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 425ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent pRvbModule->config.inputCfg.format = SAMPLE_FORMAT_PCM_S15; 426135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.bufferProvider.getBuffer = NULL; 427135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.bufferProvider.releaseBuffer = NULL; 428135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.bufferProvider.cookie = NULL; 429135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ; 430135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.mask = EFFECT_CONFIG_ALL; 431135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.samplingRate = 44100; 432135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.channels = CHANNEL_STEREO; 433ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent pRvbModule->config.outputCfg.format = SAMPLE_FORMAT_PCM_S15; 434135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.bufferProvider.getBuffer = NULL; 435135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.bufferProvider.releaseBuffer = NULL; 436135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.bufferProvider.cookie = NULL; 437135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_ACCUMULATE; 438135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.mask = EFFECT_CONFIG_ALL; 439135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 440135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ret = Reverb_Configure(pRvbModule, &pRvbModule->config, true); 441135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (ret < 0) { 442135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Init error %d on module %p", ret, pRvbModule); 443135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 444135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 445135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return ret; 446135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 447135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 448135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 449135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb_Init() 450135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 451135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 452135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Set input and output audio configuration. 453135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 454135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 455135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pRvbModule - pointer to reverb effect module 456135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pConfig - pointer to effect_config_t structure containing input 457135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * and output audio parameters configuration 458135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * init - true if called from init function 459135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 460135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 461135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 462135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 463135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 464135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 465135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 466135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Reverb_Configure(reverb_module_t *pRvbModule, effect_config_t *pConfig, 467135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bool init) { 468135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_object_t *pReverb = &pRvbModule->context; 469135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int bufferSizeInSamples; 470135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int updatePeriodInSamples; 471135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int xfadePeriodInSamples; 472135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 473135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Check configuration compatibility with build options 474135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pConfig->inputCfg.samplingRate 475135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent != pConfig->outputCfg.samplingRate 476135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent || pConfig->outputCfg.channels != OUTPUT_CHANNELS 477ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent || pConfig->inputCfg.format != SAMPLE_FORMAT_PCM_S15 478ffe9c25ce85e1af55d58ec025adc6367d70db7e8Eric Laurent || pConfig->outputCfg.format != SAMPLE_FORMAT_PCM_S15) { 479135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Configure invalid config"); 480135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 481135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 482135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if ((pReverb->m_Aux && (pConfig->inputCfg.channels != CHANNEL_MONO)) || 483135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent (!pReverb->m_Aux && (pConfig->inputCfg.channels != CHANNEL_STEREO))) { 484135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Configure invalid config"); 485135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 486135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 487135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 488135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent memcpy(&pRvbModule->config, pConfig, sizeof(effect_config_t)); 489135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 490135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSamplingRate = pRvbModule->config.outputCfg.samplingRate; 491135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 492135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (pReverb->m_nSamplingRate) { 493135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 8000: 494135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 5; 495135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 4096; 496135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = -23170; 497135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 498135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 16000: 499135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 6; 500135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 8192; 501135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = -12540; 502135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 503135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 22050: 504135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 7; 505135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 8192; 506135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = 4768; 507135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 508135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 32000: 509135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 7; 510135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 16384; 511135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = 18205; 512135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 513135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 44100: 514135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 8; 515135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 16384; 516135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = 24799; 517135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 518135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 48000: 519135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 8; 520135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 16384; 521135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = 25997; 522135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 523135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 524135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Configure invalid sampling rate %d", pReverb->m_nSamplingRate); 525135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 526135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 527135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 528135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Define a mask for circular addressing, so that array index 529135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // can wraparound and stay in array boundary of 0, 1, ..., (buffer size -1) 530135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // The buffer size MUST be a power of two 531135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nBufferMask = (int32_t) (bufferSizeInSamples - 1); 532135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* reverb parameters are updated every 2^(pReverb->m_nUpdatePeriodInBits) samples */ 533135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent updatePeriodInSamples = (int32_t) (0x1L << pReverb->m_nUpdatePeriodInBits); 534135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* 535135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent calculate the update counter by bitwise ANDING with this value to 536135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent generate a 2^n modulo value 537135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 538135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInSamples = (int32_t) updatePeriodInSamples; 539135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 540135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent xfadePeriodInSamples = (int32_t) (REVERB_XFADE_PERIOD_IN_SECONDS 541135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * (double) pReverb->m_nSamplingRate); 542135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 543135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // set xfade parameters 544135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhaseIncrement 545135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = (int16_t) (65536 / ((int16_t) xfadePeriodInSamples 546135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent / (int16_t) updatePeriodInSamples)); 547135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 548135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (init) { 549135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ReverbReadInPresets(pReverb); 550135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 551135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // for debugging purposes, allow noise generator 552135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_bUseNoise = true; 553135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 554135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // for debugging purposes, allow bypass 555cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_bBypass = 0; 556135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 557135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nNextRoom = 1; 558135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 559135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nNoise = (int16_t) 0xABCD; 560135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 561135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 562135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Reverb_Reset(pReverb, init); 563135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 564135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 565135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 566135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 567135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 568135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb_Reset() 569135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 570135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 571135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reset internal states and clear delay lines. 572135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 573135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 574135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb - pointer to reverb context 575135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * init - true if called from init function 576135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 577135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 578135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 579135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 580135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 581135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 582135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 583135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 584135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentvoid Reverb_Reset(reverb_object_t *pReverb, bool init) { 585135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int bufferSizeInSamples = (int32_t) (pReverb->m_nBufferMask + 1); 586135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int maxApSamples; 587135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int maxDelaySamples; 588135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int maxEarlySamples; 589135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int ap1In; 590135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int delay0In; 591135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int delay1In; 592135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t i; 593135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint16_t nOffset; 594135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 595135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxApSamples = ((int32_t) (MAX_AP_TIME * pReverb->m_nSamplingRate) >> 16); 596135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxDelaySamples = ((int32_t) (MAX_DELAY_TIME * pReverb->m_nSamplingRate) 597135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16); 598135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxEarlySamples = ((int32_t) (MAX_EARLY_TIME * pReverb->m_nSamplingRate) 599135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16); 600135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 601135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ap1In = (AP0_IN + maxApSamples + GUARD); 602135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent delay0In = (ap1In + maxApSamples + GUARD); 603135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent delay1In = (delay0In + maxDelaySamples + GUARD); 604135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Define the max offsets for the end points of each section 605135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // i.e., we don't expect a given section's taps to go beyond 606135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // the following limits 607135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 608135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nEarly0in = (delay1In + maxDelaySamples + GUARD); 609135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nEarly1in = (pReverb->m_nEarly0in + maxEarlySamples + GUARD); 610135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 611135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp0.m_zApIn = AP0_IN; 612135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 613135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD0In = delay0In; 614135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 615135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp1.m_zApIn = ap1In; 616135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 617135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD1In = delay1In; 618135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 619135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zOutLpfL = 0; 620135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zOutLpfR = 0; 621135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 622135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRevFbkR = 0; 623135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRevFbkL = 0; 624135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 625135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // set base index into circular buffer 626135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nBaseIndex = 0; 627135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 628135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // clear the reverb delay line 629135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; i < bufferSizeInSamples; i++) { 630135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[i] = 0; 631135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 632135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 633135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ReverbUpdateRoom(pReverb, init); 634135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 635135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdateCounter = 0; 636135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 637135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhase = -32768; 638135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 639135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSin = 0; 640135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCos = 0; 641135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSinIncrement = 0; 642135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosIncrement = 0; 643135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 644135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // set delay tap lengths 645135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 646135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 647135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD1Cross = pReverb->m_nDelay1Out - pReverb->m_nMaxExcursion 648135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent + nOffset; 649135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 650135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 651135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 652135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD0Cross = pReverb->m_nDelay0Out - pReverb->m_nMaxExcursion 653135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - nOffset; 654135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 655135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 656135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 657135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD0Self = pReverb->m_nDelay0Out - pReverb->m_nMaxExcursion 658135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - nOffset; 659135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 660135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 661135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 662135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD1Self = pReverb->m_nDelay1Out - pReverb->m_nMaxExcursion 663135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent + nOffset; 664135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 665135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 666135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 667135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb_getParameter() 668135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 669135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 670135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Get a Reverb parameter 671135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 672135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 673135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb - handle to instance data 674135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * param - parameter 675135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pValue - pointer to variable to hold retrieved value 676135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pSize - pointer to value size: maximum size as input 677135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 678135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 679135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * *pValue updated with parameter value 680135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * *pSize updated with actual value size 681135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 682135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 683135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 684135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 685135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 686135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 687135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Reverb_getParameter(reverb_object_t *pReverb, int32_t param, size_t *pSize, 688135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent void *pValue) { 689135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t *pValue32; 690135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t *pValue16; 69123e1de74359f4bb1763aef0adfebe073122b032cEric Laurent t_reverb_settings *pProperties; 692135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t i; 693135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t temp; 694135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t temp2; 695135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent size_t size; 696135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 697cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (pReverb->m_Preset) { 698cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param != REVERB_PARAM_PRESET || *pSize < sizeof(int16_t)) { 699cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 700cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 701135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent size = sizeof(int16_t); 702cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue16 = (int16_t *)pValue; 703cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // REVERB_PRESET_NONE is mapped to bypass 704cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (pReverb->m_bBypass != 0) { 705cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue16 = (int16_t)REVERB_PRESET_NONE; 706cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } else { 707cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue16 = (int16_t)(pReverb->m_nNextRoom + 1); 708cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 709cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_PRESET, preset %d", *pValue16); 710cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } else { 711cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent switch (param) { 712cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_ROOM_LEVEL: 713cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_ROOM_HF_LEVEL: 714cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DECAY_HF_RATIO: 715cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REFLECTIONS_LEVEL: 716cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REVERB_LEVEL: 717cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DIFFUSION: 718cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DENSITY: 719cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent size = sizeof(int16_t); 720cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 721135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 722cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_BYPASS: 723cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DECAY_TIME: 724cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REFLECTIONS_DELAY: 725cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REVERB_DELAY: 726cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent size = sizeof(int32_t); 727cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 728135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 729cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_PROPERTIES: 73023e1de74359f4bb1763aef0adfebe073122b032cEric Laurent size = sizeof(t_reverb_settings); 731cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 732135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 733cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent default: 734cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 735cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 736135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 737cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (*pSize < size) { 738cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 739cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 740135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 741cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue32 = (int32_t *) pValue; 742cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue16 = (int16_t *) pValue; 74323e1de74359f4bb1763aef0adfebe073122b032cEric Laurent pProperties = (t_reverb_settings *) pValue; 744135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 745cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent switch (param) { 746cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_BYPASS: 747cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue32 = (int32_t) pReverb->m_bBypass; 748135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 749135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 750cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_PROPERTIES: 751cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue16 = &pProperties->roomLevel; 752cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 753135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 754cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_ROOM_LEVEL: 755cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert m_nRoomLpfFwd to millibels 756cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (pReverb->m_nRoomLpfFwd << 15) 757cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent / (32767 - pReverb->m_nRoomLpfFbk); 758cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue16 = Effects_Linear16ToMillibels(temp); 759135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 760cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_ROOM_LEVEL %d, gain %d, m_nRoomLpfFwd %d, m_nRoomLpfFbk %d", *pValue16, temp, pReverb->m_nRoomLpfFwd, pReverb->m_nRoomLpfFbk); 761135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 762cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_ROOM_LEVEL) { 763cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 764cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 765cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue16 = &pProperties->roomHFLevel; 766cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 767cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 768cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_ROOM_HF_LEVEL: 769cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // The ratio between linear gain at 0Hz and at 5000Hz for the room low pass is: 770cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // (1 + a1) / sqrt(a1^2 + 2*C*a1 + 1) where: 771cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // - a1 is minus the LP feedback gain: -pReverb->m_nRoomLpfFbk 772cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // - C is cos(2piWT) @ 5000Hz: pReverb->m_nCosWT_5KHz 773cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 774cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = MULT_EG1_EG1(pReverb->m_nRoomLpfFbk, pReverb->m_nRoomLpfFbk); 775cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_ROOM_HF_LEVEL, a1^2 %d", temp); 776cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp2 = MULT_EG1_EG1(pReverb->m_nRoomLpfFbk, pReverb->m_nCosWT_5KHz) 777135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent << 1; 778cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_ROOM_HF_LEVEL, 2 Cos a1 %d", temp2); 779135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = 32767 + temp - temp2; 780cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_ROOM_HF_LEVEL, a1^2 + 2 Cos a1 + 1 %d", temp); 781135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = Effects_Sqrt(temp) * 181; 782cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_ROOM_HF_LEVEL, SQRT(a1^2 + 2 Cos a1 + 1) %d", temp); 783cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = ((32767 - pReverb->m_nRoomLpfFbk) << 15) / temp; 784cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 785cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_ROOM_HF_LEVEL, gain %d, m_nRoomLpfFwd %d, m_nRoomLpfFbk %d", temp, pReverb->m_nRoomLpfFwd, pReverb->m_nRoomLpfFbk); 786cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 787cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue16 = Effects_Linear16ToMillibels(temp); 788cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 789cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_ROOM_HF_LEVEL) { 790cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 791cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 792cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue32 = &pProperties->decayTime; 793cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 794135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 795cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DECAY_TIME: 796cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Calculate reverb feedback path gain 797cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (pReverb->m_nRvbLpfFwd << 15) / (32767 - pReverb->m_nRvbLpfFbk); 798135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = Effects_Linear16ToMillibels(temp); 799135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 800cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Calculate decay time: g = -6000 d/DT , g gain in millibels, d reverb delay, DT decay time 801cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (-6000 * pReverb->m_nLateDelay) / temp; 802135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 803cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert samples to ms 804cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue32 = (temp * 1000) / pReverb->m_nSamplingRate; 805135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 806cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_DECAY_TIME, samples %d, ms %d", temp, *pValue32); 807135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 808cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_DECAY_TIME) { 809cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 810cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 811cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue16 = &pProperties->decayHFRatio; 812cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 813cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 814cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DECAY_HF_RATIO: 815cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // If r is the decay HF ratio (r = REVERB_PARAM_DECAY_HF_RATIO/1000) we have: 816cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // DT_5000Hz = DT_0Hz * r 817cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // and G_5000Hz = -6000 * d / DT_5000Hz and G_0Hz = -6000 * d / DT_0Hz in millibels so : 818cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // r = G_0Hz/G_5000Hz in millibels 819cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // The linear gain at 5000Hz is b0 / sqrt(a1^2 + 2*C*a1 + 1) where: 820cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // - a1 is minus the LP feedback gain: -pReverb->m_nRvbLpfFbk 821cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // - b0 is the LP forward gain: pReverb->m_nRvbLpfFwd 822cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // - C is cos(2piWT) @ 5000Hz: pReverb->m_nCosWT_5KHz 823cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (pReverb->m_nRvbLpfFbk == 0) { 824cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue16 = 1000; 825cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_DECAY_HF_RATIO, pReverb->m_nRvbLpfFbk == 0, ratio %d", *pValue16); 826cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } else { 827cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = MULT_EG1_EG1(pReverb->m_nRvbLpfFbk, pReverb->m_nRvbLpfFbk); 828cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp2 = MULT_EG1_EG1(pReverb->m_nRvbLpfFbk, pReverb->m_nCosWT_5KHz) 829cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent << 1; 830cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = 32767 + temp - temp2; 831cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = Effects_Sqrt(temp) * 181; 832cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (pReverb->m_nRvbLpfFwd << 15) / temp; 833cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // The linear gain at 0Hz is b0 / (a1 + 1) 834cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp2 = (pReverb->m_nRvbLpfFwd << 15) / (32767 835cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent - pReverb->m_nRvbLpfFbk); 836cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 837cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = Effects_Linear16ToMillibels(temp); 838cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp2 = Effects_Linear16ToMillibels(temp2); 839cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_DECAY_HF_RATIO, gain 5KHz %d mB, gain DC %d mB", temp, temp2); 840cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 841cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp == 0) 842cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = 1; 843cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (int16_t) ((1000 * temp2) / temp); 844cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp > 1000) 845cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = 1000; 846cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 847cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue16 = temp; 848cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_DECAY_HF_RATIO, ratio %d", *pValue16); 849cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 850135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 851cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_DECAY_HF_RATIO) { 852cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 853cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 854cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue16 = &pProperties->reflectionsLevel; 855cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 856135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 857cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REFLECTIONS_LEVEL: 858cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue16 = Effects_Linear16ToMillibels(pReverb->m_nEarlyGain); 859135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 860cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_REFLECTIONS_LEVEL, %d", *pValue16); 861cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_REFLECTIONS_LEVEL) { 862cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 863cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 864cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue32 = &pProperties->reflectionsDelay; 865cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 866135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 867cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REFLECTIONS_DELAY: 868cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // convert samples to ms 869cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue32 = (pReverb->m_nEarlyDelay * 1000) / pReverb->m_nSamplingRate; 870135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 871cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_REFLECTIONS_DELAY, samples %d, ms %d", pReverb->m_nEarlyDelay, *pValue32); 872135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 873cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_REFLECTIONS_DELAY) { 874cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 875cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 876cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue16 = &pProperties->reverbLevel; 877cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 878135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 879cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REVERB_LEVEL: 880cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert linear gain to millibels 881cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue16 = Effects_Linear16ToMillibels(pReverb->m_nLateGain << 2); 882135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 883cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_REVERB_LEVEL %d", *pValue16); 884135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 885cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_REVERB_LEVEL) { 886cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 887cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 888cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue32 = &pProperties->reverbDelay; 889cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 890135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 891cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REVERB_DELAY: 892cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // convert samples to ms 893cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue32 = (pReverb->m_nLateDelay * 1000) / pReverb->m_nSamplingRate; 894135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 895cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_REVERB_DELAY, samples %d, ms %d", pReverb->m_nLateDelay, *pValue32); 896135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 897cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_REVERB_DELAY) { 898cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 899cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 900cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue16 = &pProperties->diffusion; 901cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 902135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 903cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DIFFUSION: 904cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (int16_t) ((1000 * (pReverb->m_sAp0.m_nApGain - AP0_GAIN_BASE)) 905cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent / AP0_GAIN_RANGE); 906135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 907cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp < 0) 908cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = 0; 909cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp > 1000) 910cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = 1000; 911135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 912cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue16 = temp; 913cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_DIFFUSION, %d, AP0 gain %d", *pValue16, pReverb->m_sAp0.m_nApGain); 914135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 915cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_DIFFUSION) { 916cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 917cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 918cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pValue16 = &pProperties->density; 919cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 920135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 921cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DENSITY: 922cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Calculate AP delay in time units 923cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = ((pReverb->m_sAp0.m_zApOut - pReverb->m_sAp0.m_zApIn) << 16) 924cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent / pReverb->m_nSamplingRate; 925135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 926cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (int16_t) ((1000 * (temp - AP0_TIME_BASE)) / AP0_TIME_RANGE); 927135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 928cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp < 0) 929cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = 0; 930cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp > 1000) 931cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = 1000; 932135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 933cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pValue16 = temp; 934cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 935cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("get REVERB_PARAM_DENSITY, %d, AP0 delay smps %d", *pValue16, pReverb->m_sAp0.m_zApOut - pReverb->m_sAp0.m_zApIn); 936cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 937cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 938cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent default: 939cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 940cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 941135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 942135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 943cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent *pSize = size; 944cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 945135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_getParameter, context %p, param %d, value %d", 946135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb, param, *(int *)pValue); 947135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 948135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 949135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end Reverb_getParameter */ 950135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 951135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 952135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb_setParameter() 953135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 954135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 955135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Set a Reverb parameter 956135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 957135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 958135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb - handle to instance data 959135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * param - parameter 960135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pValue - pointer to parameter value 961135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * size - value size 962135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 963135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 964135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 965135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 966135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 967135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 968135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 969135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 970135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Reverb_setParameter(reverb_object_t *pReverb, int32_t param, size_t size, 971135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent void *pValue) { 972135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t value32; 973135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t value16; 97423e1de74359f4bb1763aef0adfebe073122b032cEric Laurent t_reverb_settings *pProperties; 975135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t i; 976135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t temp; 977135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t temp2; 978135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_preset_t *pPreset; 979135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int maxSamples; 980135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t averageDelay; 981135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent size_t paramSize; 982135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 983135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_setParameter, context %p, param %d, value16 %d, value32 %d", 984135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb, param, *(int16_t *)pValue, *(int32_t *)pValue); 985135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 986cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (pReverb->m_Preset) { 987cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param != REVERB_PARAM_PRESET || size != sizeof(int16_t)) { 988135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 989cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 990cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value16 = *(int16_t *)pValue; 991cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("set REVERB_PARAM_PRESET, preset %d", value16); 992cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (value16 < REVERB_PRESET_NONE || value16 > REVERB_PRESET_PLATE) { 993135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 994cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 995cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // REVERB_PRESET_NONE is mapped to bypass 996cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (value16 == REVERB_PRESET_NONE) { 997cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_bBypass = 1; 998cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } else { 999cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_bBypass = 0; 1000cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nNextRoom = value16 - 1; 1001cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 1002cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } else { 1003cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent switch (param) { 1004cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_ROOM_LEVEL: 1005cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_ROOM_HF_LEVEL: 1006cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DECAY_HF_RATIO: 1007cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REFLECTIONS_LEVEL: 1008cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REVERB_LEVEL: 1009cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DIFFUSION: 1010cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DENSITY: 1011cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent paramSize = sizeof(int16_t); 1012cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1013135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1014cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_BYPASS: 1015cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DECAY_TIME: 1016cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REFLECTIONS_DELAY: 1017cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REVERB_DELAY: 1018cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent paramSize = sizeof(int32_t); 1019135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1020135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1021cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_PROPERTIES: 102223e1de74359f4bb1763aef0adfebe073122b032cEric Laurent paramSize = sizeof(t_reverb_settings); 1023cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1024135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1025cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent default: 1026135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 1027135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1028135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1029cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (size != paramSize) { 1030135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 1031cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 1032135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1033cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (paramSize == sizeof(int16_t)) { 1034cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value16 = *(int16_t *) pValue; 1035cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } else if (paramSize == sizeof(int32_t)) { 1036cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value32 = *(int32_t *) pValue; 1037cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } else { 103823e1de74359f4bb1763aef0adfebe073122b032cEric Laurent pProperties = (t_reverb_settings *) pValue; 1039cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 1040135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1041cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset = &pReverb->m_sPreset.m_sPreset[pReverb->m_nNextRoom]; 1042135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1043cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent switch (param) { 1044cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_BYPASS: 1045cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_bBypass = (uint16_t)value32; 1046135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1047135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1048cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_PROPERTIES: 1049cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value16 = pProperties->roomLevel; 1050cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 1051135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1052cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_ROOM_LEVEL: 1053cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert millibels to linear 16 bit signed => m_nRoomLpfFwd 1054cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (value16 > 0) 1055cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 1056135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1057cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = Effects_MillibelsToLinear16(value16); 1058135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1059cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nRoomLpfFwd 1060cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent = MULT_EG1_EG1(temp, (32767 - pReverb->m_nRoomLpfFbk)); 1061cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1062cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_ROOM_LEVEL, gain %d, new m_nRoomLpfFwd %d, m_nRoomLpfFbk %d", temp, pReverb->m_nRoomLpfFwd, pReverb->m_nRoomLpfFbk); 1063cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_ROOM_LEVEL) 1064cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1065cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value16 = pProperties->roomHFLevel; 1066cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 1067cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1068cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_ROOM_HF_LEVEL: 1069cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1070cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Limit to 0 , -40dB range because of low pass implementation 1071cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (value16 > 0 || value16 < -4000) 1072cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 1073cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert attenuation @ 5000H expressed in millibels to => m_nRoomLpfFbk 1074cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // m_nRoomLpfFbk is -a1 where a1 is the solution of: 1075cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // a1^2 + 2*(C-dG^2)/(1-dG^2)*a1 + 1 = 0 where: 1076cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // - C is cos(2*pi*5000/Fs) (pReverb->m_nCosWT_5KHz) 1077cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // - dG is G0/Gf (G0 is the linear gain at DC and Gf is the wanted gain at 5000Hz) 1078cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1079cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Save current DC gain m_nRoomLpfFwd / (32767 - m_nRoomLpfFbk) to keep it unchanged 1080cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // while changing HF level 1081cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp2 = (pReverb->m_nRoomLpfFwd << 15) / (32767 1082cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent - pReverb->m_nRoomLpfFbk); 1083cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (value16 == 0) { 1084cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nRoomLpfFbk = 0; 1085cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } else { 1086cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent int32_t dG2, b, delta; 1087cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1088cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // dG^2 1089cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = Effects_MillibelsToLinear16(value16); 1090cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, HF gain %d", temp); 1091cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (1 << 30) / temp; 1092cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, 1/ HF gain %d", temp); 1093cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent dG2 = (int32_t) (((int64_t) temp * (int64_t) temp) >> 15); 1094cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, 1/ HF gain ^ 2 %d", dG2); 1095cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // b = 2*(C-dG^2)/(1-dG^2) 1096cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent b = (int32_t) ((((int64_t) 1 << (15 + 1)) 1097cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent * ((int64_t) pReverb->m_nCosWT_5KHz - (int64_t) dG2)) 1098cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent / ((int64_t) 32767 - (int64_t) dG2)); 1099cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1100cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // delta = b^2 - 4 1101cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent delta = (int32_t) ((((int64_t) b * (int64_t) b) >> 15) - (1 << (15 1102cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent + 2))); 1103cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1104cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV_IF(delta > (1<<30), " delta overflow %d", delta); 1105cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1106cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, dG2 %d, b %d, delta %d, m_nCosWT_5KHz %d", dG2, b, delta, pReverb->m_nCosWT_5KHz); 1107cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // m_nRoomLpfFbk = -a1 = - (- b + sqrt(delta)) / 2 1108cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nRoomLpfFbk = (b - Effects_Sqrt(delta) * 181) >> 1; 1109cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 1110cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, olg DC gain %d new m_nRoomLpfFbk %d, old m_nRoomLpfFwd %d", 1111cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp2, pReverb->m_nRoomLpfFbk, pReverb->m_nRoomLpfFwd); 1112cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1113cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nRoomLpfFwd 1114cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent = MULT_EG1_EG1(temp2, (32767 - pReverb->m_nRoomLpfFbk)); 1115cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, new m_nRoomLpfFwd %d", pReverb->m_nRoomLpfFwd); 1116cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1117cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_ROOM_HF_LEVEL) 1118cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1119cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value32 = pProperties->decayTime; 1120cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 1121cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1122cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DECAY_TIME: 1123cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1124cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert milliseconds to => m_nRvbLpfFwd (function of m_nRvbLpfFbk) 1125cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // convert ms to samples 1126cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value32 = (value32 * pReverb->m_nSamplingRate) / 1000; 1127cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1128cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // calculate valid decay time range as a function of current reverb delay and 1129cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // max feed back gain. Min value <=> -40dB in one pass, Max value <=> feedback gain = -1 dB 1130cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Calculate attenuation for each round in late reverb given a total attenuation of -6000 millibels. 1131cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // g = -6000 d/DT , g gain in millibels, d reverb delay, DT decay time 1132cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent averageDelay = pReverb->m_nLateDelay - pReverb->m_nMaxExcursion; 1133cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent averageDelay += ((pReverb->m_sAp0.m_zApOut - pReverb->m_sAp0.m_zApIn) 1134cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent + (pReverb->m_sAp1.m_zApOut - pReverb->m_sAp1.m_zApIn)) >> 1; 1135cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1136cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (-6000 * averageDelay) / value32; 1137cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_DECAY_TIME, delay smps %d, DT smps %d, gain mB %d",averageDelay, value32, temp); 1138cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp < -4000 || temp > -100) 1139cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 1140cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1141cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // calculate low pass gain by adding reverb input attenuation (pReverb->m_nLateGain) and substrating output 1142cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // xfade and sum gain (max +9dB) 1143cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp -= Effects_Linear16ToMillibels(pReverb->m_nLateGain) + 900; 1144cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = Effects_MillibelsToLinear16(temp); 1145135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1146cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // DC gain (temp) = b0 / (1 + a1) = pReverb->m_nRvbLpfFwd / (32767 - pReverb->m_nRvbLpfFbk) 1147cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nRvbLpfFwd 1148cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent = MULT_EG1_EG1(temp, (32767 - pReverb->m_nRvbLpfFbk)); 1149135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1150cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_DECAY_TIME, gain %d, new m_nRvbLpfFwd %d, old m_nRvbLpfFbk %d, reverb gain %d", temp, pReverb->m_nRvbLpfFwd, pReverb->m_nRvbLpfFbk, Effects_Linear16ToMillibels(pReverb->m_nLateGain)); 1151135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1152cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_DECAY_TIME) 1153cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1154cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value16 = pProperties->decayHFRatio; 1155cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 1156135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1157cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DECAY_HF_RATIO: 1158135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1159cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // We limit max value to 1000 because reverb filter is lowpass only 1160cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (value16 < 100 || value16 > 1000) 1161cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 1162cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert per mille to => m_nLpfFwd, m_nLpfFbk 1163135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1164cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Save current DC gain m_nRoomLpfFwd / (32767 - m_nRoomLpfFbk) to keep it unchanged 1165cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // while changing HF level 1166cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp2 = (pReverb->m_nRvbLpfFwd << 15) / (32767 - pReverb->m_nRvbLpfFbk); 1167135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1168cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (value16 == 1000) { 1169cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nRvbLpfFbk = 0; 1170cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } else { 1171cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent int32_t dG2, b, delta; 1172135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1173cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = Effects_Linear16ToMillibels(temp2); 1174cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // G_5000Hz = G_DC * (1000/REVERB_PARAM_DECAY_HF_RATIO) in millibels 1175135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1176cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value32 = ((int32_t) 1000 << 15) / (int32_t) value16; 1177cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_DECAY_HF_RATIO, DC gain %d, DC gain mB %d, 1000/R %d", temp2, temp, value32); 1178135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1179cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (int32_t) (((int64_t) temp * (int64_t) value32) >> 15); 1180135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1181cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp < -4000) { 1182cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_DECAY_HF_RATIO HF gain overflow %d mB", temp); 1183cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = -4000; 1184cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 1185135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1186cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = Effects_MillibelsToLinear16(temp); 1187cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_DECAY_HF_RATIO, HF gain %d", temp); 1188cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // dG^2 1189cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (temp2 << 15) / temp; 1190cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent dG2 = (int32_t) (((int64_t) temp * (int64_t) temp) >> 15); 1191135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1192cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // b = 2*(C-dG^2)/(1-dG^2) 1193cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent b = (int32_t) ((((int64_t) 1 << (15 + 1)) 1194cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent * ((int64_t) pReverb->m_nCosWT_5KHz - (int64_t) dG2)) 1195cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent / ((int64_t) 32767 - (int64_t) dG2)); 1196135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1197cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // delta = b^2 - 4 1198cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent delta = (int32_t) ((((int64_t) b * (int64_t) b) >> 15) - (1 << (15 1199cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent + 2))); 1200135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1201cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // m_nRoomLpfFbk = -a1 = - (- b + sqrt(delta)) / 2 1202cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nRvbLpfFbk = (b - Effects_Sqrt(delta) * 181) >> 1; 1203135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1204cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_DECAY_HF_RATIO, dG2 %d, b %d, delta %d", dG2, b, delta); 1205135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1206cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 1207135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1208cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_DECAY_HF_RATIO, gain %d, m_nRvbLpfFbk %d, m_nRvbLpfFwd %d", temp2, pReverb->m_nRvbLpfFbk, pReverb->m_nRvbLpfFwd); 1209135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1210cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nRvbLpfFwd 1211cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent = MULT_EG1_EG1(temp2, (32767 - pReverb->m_nRvbLpfFbk)); 1212135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1213cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_DECAY_HF_RATIO) 1214cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1215cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value16 = pProperties->reflectionsLevel; 1216cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 1217135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1218cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REFLECTIONS_LEVEL: 1219cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // We limit max value to 0 because gain is limited to 0dB 1220cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (value16 > 0 || value16 < -6000) 1221cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 1222135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1223cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert millibels to linear 16 bit signed and recompute m_sEarlyL.m_nGain[i] and m_sEarlyR.m_nGain[i]. 1224cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value16 = Effects_MillibelsToLinear16(value16); 1225cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent for (i = 0; i < REVERB_MAX_NUM_REFLECTIONS; i++) { 1226cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_sEarlyL.m_nGain[i] 1227cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent = MULT_EG1_EG1(pPreset->m_sEarlyL.m_nGain[i],value16); 1228cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_sEarlyR.m_nGain[i] 1229cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent = MULT_EG1_EG1(pPreset->m_sEarlyR.m_nGain[i],value16); 1230cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 1231cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nEarlyGain = value16; 1232cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_REFLECTIONS_LEVEL, m_nEarlyGain %d", pReverb->m_nEarlyGain); 1233cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1234cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_REFLECTIONS_LEVEL) 1235cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1236cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value32 = pProperties->reflectionsDelay; 1237cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 1238cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1239cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REFLECTIONS_DELAY: 1240cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // We limit max value MAX_EARLY_TIME 1241cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // convert ms to time units 1242cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (value32 * 65536) / 1000; 1243cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp < 0 || temp > MAX_EARLY_TIME) 1244cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 1245cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1246cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent maxSamples = (int32_t) (MAX_EARLY_TIME * pReverb->m_nSamplingRate) 1247cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent >> 16; 1248cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1249cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent for (i = 0; i < REVERB_MAX_NUM_REFLECTIONS; i++) { 1250cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp2 = temp + (((int32_t) pPreset->m_sEarlyL.m_zDelay[i] 1251cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent * pReverb->m_nSamplingRate) >> 16); 1252cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp2 > maxSamples) 1253cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp2 = maxSamples; 1254cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_sEarlyL.m_zDelay[i] = pReverb->m_nEarly0in + temp2; 1255cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp2 = temp + (((int32_t) pPreset->m_sEarlyR.m_zDelay[i] 1256cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent * pReverb->m_nSamplingRate) >> 16); 1257cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp2 > maxSamples) 1258cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp2 = maxSamples; 1259cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_sEarlyR.m_zDelay[i] = pReverb->m_nEarly1in + temp2; 1260cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 1261cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nEarlyDelay = temp; 1262cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1263cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_REFLECTIONS_DELAY, m_nEarlyDelay smps %d max smp delay %d", pReverb->m_nEarlyDelay, maxSamples); 1264cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1265cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert milliseconds to sample count => m_nEarlyDelay 1266cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_REFLECTIONS_DELAY) 1267cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1268cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value16 = pProperties->reverbLevel; 1269cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 1270cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1271cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REVERB_LEVEL: 1272cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // We limit max value to 0 because gain is limited to 0dB 1273cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (value16 > 0 || value16 < -6000) 1274cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 1275cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert millibels to linear 16 bits (gange 0 - 8191) => m_nLateGain. 1276cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nLateGain = Effects_MillibelsToLinear16(value16) >> 2; 1277cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1278cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_REVERB_LEVEL, m_nLateGain %d", pReverb->m_nLateGain); 1279cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1280cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_REVERB_LEVEL) 1281cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1282cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value32 = pProperties->reverbDelay; 1283cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 1284cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1285cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_REVERB_DELAY: 1286cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // We limit max value to MAX_DELAY_TIME 1287cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // convert ms to time units 1288cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (value32 * 65536) / 1000; 1289cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp < 0 || temp > MAX_DELAY_TIME) 1290cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 1291cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1292cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent maxSamples = (int32_t) (MAX_DELAY_TIME * pReverb->m_nSamplingRate) 1293cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent >> 16; 1294cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1295cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if ((temp + pReverb->m_nMaxExcursion) > maxSamples) { 1296cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = maxSamples - pReverb->m_nMaxExcursion; 1297cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 1298cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp < pReverb->m_nMaxExcursion) { 1299cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = pReverb->m_nMaxExcursion; 1300cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 1301135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1302cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp -= pReverb->m_nLateDelay; 1303cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nDelay0Out += temp; 1304cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nDelay1Out += temp; 1305cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_nLateDelay += temp; 1306135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1307cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_REVERB_DELAY, m_nLateDelay smps %d max smp delay %d", pReverb->m_nLateDelay, maxSamples); 1308135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1309cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert milliseconds to sample count => m_nDelay1Out + m_nMaxExcursion 1310cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_REVERB_DELAY) 1311cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1312135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1313cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value16 = pProperties->diffusion; 1314cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 1315135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1316cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DIFFUSION: 1317cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (value16 < 0 || value16 > 1000) 1318cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 1319135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1320cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert per mille to m_sAp0.m_nApGain, m_sAp1.m_nApGain 1321cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_sAp0.m_nApGain = AP0_GAIN_BASE + ((int32_t) value16 1322cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent * AP0_GAIN_RANGE) / 1000; 1323cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_sAp1.m_nApGain = AP1_GAIN_BASE + ((int32_t) value16 1324cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent * AP1_GAIN_RANGE) / 1000; 1325135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1326cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_DIFFUSION, m_sAp0.m_nApGain %d m_sAp1.m_nApGain %d", pReverb->m_sAp0.m_nApGain, pReverb->m_sAp1.m_nApGain); 1327135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1328cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (param == REVERB_PARAM_DIFFUSION) 1329cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1330135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1331cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent value16 = pProperties->density; 1332cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /* FALL THROUGH */ 1333135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1334cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PARAM_DENSITY: 1335cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (value16 < 0 || value16 > 1000) 1336cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent return -EINVAL; 1337135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1338cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // Convert per mille to m_sAp0.m_zApOut, m_sAp1.m_zApOut 1339cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent maxSamples = (int32_t) (MAX_AP_TIME * pReverb->m_nSamplingRate) >> 16; 1340135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1341cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = AP0_TIME_BASE + ((int32_t) value16 * AP0_TIME_RANGE) / 1000; 1342cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /*lint -e{702} shift for performance */ 1343cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1344cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp > maxSamples) 1345cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = maxSamples; 1346cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_sAp0.m_zApOut = (uint16_t) (pReverb->m_sAp0.m_zApIn + temp); 1347135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1348cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("REVERB_PARAM_DENSITY, Ap0 delay smps %d", temp); 1349135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1350cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = AP1_TIME_BASE + ((int32_t) value16 * AP1_TIME_RANGE) / 1000; 1351cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent /*lint -e{702} shift for performance */ 1352cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1353cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent if (temp > maxSamples) 1354cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent temp = maxSamples; 1355cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pReverb->m_sAp1.m_zApOut = (uint16_t) (pReverb->m_sAp1.m_zApIn + temp); 1356135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1357cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent LOGV("Ap1 delay smps %d", temp); 1358135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1359cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1360135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1361cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent default: 1362cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 1363cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent } 1364135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1365cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent 1366135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 1367135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end Reverb_setParameter */ 1368135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1369135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1370135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ReverbUpdateXfade 1371135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1372135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 1373135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Update the xfade parameters as required 1374135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1375135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1376135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * nNumSamplesToAdd - number of samples to write to buffer 1377135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1378135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1379135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1380135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1381135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 1382135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * - xfade parameters will be changed 1383135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1384135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1385135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1386135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int ReverbUpdateXfade(reverb_object_t *pReverb, int nNumSamplesToAdd) { 1387135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint16_t nOffset; 1388135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t tempCos; 1389135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t tempSin; 1390135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1391135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_nXfadeCounter >= pReverb->m_nXfadeInterval) { 1392135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* update interval has elapsed, so reset counter */ 1393135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nXfadeCounter = 0; 1394135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1395135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Pin the sin,cos values to min / max values to ensure that the 1396135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // modulated taps' coefs are zero (thus no clicks) 1397135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_nPhaseIncrement > 0) { 1398135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // if phase increment > 0, then sin -> 1, cos -> 0 1399135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSin = 32767; 1400135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCos = 0; 1401135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1402135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // reset the phase to match the sin, cos values 1403135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhase = 32767; 1404135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1405135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // modulate the cross taps because their tap coefs are zero 1406135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 1407135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1408135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD1Cross = pReverb->m_nDelay1Out 1409135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - pReverb->m_nMaxExcursion + nOffset; 1410135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1411135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 1412135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1413135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD0Cross = pReverb->m_nDelay0Out 1414135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - pReverb->m_nMaxExcursion - nOffset; 1415135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 1416135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // if phase increment < 0, then sin -> 0, cos -> 1 1417135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSin = 0; 1418135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCos = 32767; 1419135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1420135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // reset the phase to match the sin, cos values 1421135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhase = -32768; 1422135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1423135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // modulate the self taps because their tap coefs are zero 1424135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 1425135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1426135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD0Self = pReverb->m_nDelay0Out 1427135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - pReverb->m_nMaxExcursion - nOffset; 1428135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1429135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 1430135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1431135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD1Self = pReverb->m_nDelay1Out 1432135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - pReverb->m_nMaxExcursion + nOffset; 1433135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1434135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } // end if-else (pReverb->m_nPhaseIncrement > 0) 1435135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1436135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Reverse the direction of the sin,cos so that the 1437135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // tap whose coef was previously increasing now decreases 1438135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // and vice versa 1439135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhaseIncrement = -pReverb->m_nPhaseIncrement; 1440135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1441135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } // end if counter >= update interval 1442135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1443135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //compute what phase will be next time 1444135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhase += pReverb->m_nPhaseIncrement; 1445135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1446135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //calculate what the new sin and cos need to reach by the next update 1447135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ReverbCalculateSinCos(pReverb->m_nPhase, &tempSin, &tempCos); 1448135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1449135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //calculate the per-sample increment required to get there by the next update 1450135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1451135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSinIncrement = (tempSin - pReverb->m_nSin) 1452135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> pReverb->m_nUpdatePeriodInBits; 1453135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1454135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1455135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosIncrement = (tempCos - pReverb->m_nCos) 1456135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> pReverb->m_nUpdatePeriodInBits; 1457135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1458135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* increment update counter */ 1459135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nXfadeCounter += (uint16_t) nNumSamplesToAdd; 1460135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1461135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 1462135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1463135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end ReverbUpdateXfade */ 1464135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1465135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1466135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ReverbCalculateNoise 1467135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1468135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 1469135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Calculate a noise sample and limit its value 1470135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1471135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1472135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * nMaxExcursion - noise value is limited to this value 1473135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pnNoise - return new noise sample in this (not limited) 1474135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1475135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1476135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * new limited noise value 1477135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1478135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 1479135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * - *pnNoise noise value is updated 1480135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1481135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1482135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1483135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic uint16_t ReverbCalculateNoise(reverb_object_t *pReverb) { 1484135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t nNoise = pReverb->m_nNoise; 1485135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1486135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate new noise value 1487135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_bUseNoise) { 1488135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nNoise = (int16_t) (nNoise * 5 + 1); 1489135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 1490135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nNoise = 0; 1491135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1492135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1493135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nNoise = nNoise; 1494135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // return the limited noise value 1495135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return (pReverb->m_nMaxExcursion & nNoise); 1496135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1497135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end ReverbCalculateNoise */ 1498135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1499135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1500135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ReverbCalculateSinCos 1501135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1502135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 1503135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Calculate a new sin and cosine value based on the given phase 1504135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1505135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1506135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * nPhase - phase angle 1507135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pnSin - input old value, output new value 1508135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pnCos - input old value, output new value 1509135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1510135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1511135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1512135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 1513135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * - *pnSin, *pnCos are updated 1514135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1515135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1516135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1517135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int ReverbCalculateSinCos(int16_t nPhase, int16_t *pnSin, int16_t *pnCos) { 1518135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nTemp; 1519135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nNetAngle; 1520135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1521135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // -1 <= nPhase < 1 1522135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // However, for the calculation, we need a value 1523135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // that ranges from -1/2 to +1/2, so divide the phase by 2 1524135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1525135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nNetAngle = nPhase >> 1; 1526135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1527135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* 1528135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Implement the following 1529135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent sin(x) = (2-4*c)*x^2 + c + x 1530135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent cos(x) = (2-4*c)*x^2 + c - x 1531135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1532135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent where c = 1/sqrt(2) 1533135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent using the a0 + x*(a1 + x*a2) approach 1534135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1535135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1536135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* limit the input "angle" to be between -0.5 and +0.5 */ 1537135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (nNetAngle > EG1_HALF) { 1538135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nNetAngle = EG1_HALF; 1539135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else if (nNetAngle < EG1_MINUS_HALF) { 1540135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nNetAngle = EG1_MINUS_HALF; 1541135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1542135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1543135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* calculate sin */ 1544135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp = EG1_ONE + MULT_EG1_EG1(REVERB_PAN_G2, nNetAngle); 1545135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp = REVERB_PAN_G0 + MULT_EG1_EG1(nTemp, nNetAngle); 1546135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pnSin = (int16_t) SATURATE_EG1(nTemp); 1547135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1548135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* calculate cos */ 1549135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp = -EG1_ONE + MULT_EG1_EG1(REVERB_PAN_G2, nNetAngle); 1550135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp = REVERB_PAN_G0 + MULT_EG1_EG1(nTemp, nNetAngle); 1551135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pnCos = (int16_t) SATURATE_EG1(nTemp); 1552135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1553135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 1554135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end ReverbCalculateSinCos */ 1555135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1556135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1557135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb 1558135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1559135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 1560135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * apply reverb to the given signal 1561135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1562135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1563135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * nNu 1564135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pnSin - input old value, output new value 1565135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pnCos - input old value, output new value 1566135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1567135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1568135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * number of samples actually reverberated 1569135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1570135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 1571135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1572135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1573135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1574135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int Reverb(reverb_object_t *pReverb, int nNumSamplesToAdd, 1575135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent short *pOutputBuffer, short *pInputBuffer) { 1576135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t i; 1577135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nDelayOut0; 1578135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nDelayOut1; 1579135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint16_t nBase; 1580135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1581135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint32_t nAddr; 1582135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nTemp1; 1583135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nTemp2; 1584135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nApIn; 1585135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nApOut; 1586135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1587135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t j; 1588135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nEarlyOut; 1589135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1590135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t tempValue; 1591135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1592135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // get the base address 1593135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nBase = pReverb->m_nBaseIndex; 1594135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1595135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; i < nNumSamplesToAdd; i++) { 1596135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** Left Allpass - start 1597135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = *pInputBuffer; 1598135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (!pReverb->m_Aux) { 1599135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pInputBuffer++; 1600135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1601135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // store to early delay line 1602135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_nEarly0in, pReverb->m_nBufferMask); 1603135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nApIn; 1604135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1605135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // left input = (left dry * m_nLateGain) + right feedback from previous period 1606135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1607135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = SATURATE(nApIn + pReverb->m_nRevFbkR); 1608135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = MULT_EG1_EG1(nApIn, pReverb->m_nLateGain); 1609135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1610135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch allpass delay line out 1611135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //nAddr = CIRCULAR(nBase, psAp0->m_zApOut, pReverb->m_nBufferMask); 1612135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1613135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sAp0.m_zApOut, pReverb->m_nBufferMask); 1614135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = pReverb->m_nDelayLine[nAddr]; 1615135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1616135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate allpass feedforward; subtract the feedforward result 1617135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nApIn, pReverb->m_sAp0.m_nApGain); 1618135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApOut = SATURATE(nDelayOut0 - nTemp1); // allpass output 1619135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1620135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate allpass feedback; add the feedback result 1621135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nApOut, pReverb->m_sAp0.m_nApGain); 1622135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = SATURATE(nApIn + nTemp1); 1623135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1624135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // inject into allpass delay 1625135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1626135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sAp0.m_zApIn, pReverb->m_nBufferMask); 1627135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nTemp1; 1628135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1629135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // inject allpass output into delay line 1630135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD0In, pReverb->m_nBufferMask); 1631135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nApOut; 1632135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1633135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** Left Allpass - end 1634135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1635135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** Right Allpass - start 1636135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = (*pInputBuffer++); 1637135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // store to early delay line 1638135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_nEarly1in, pReverb->m_nBufferMask); 1639135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nApIn; 1640135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1641135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // right input = (right dry * m_nLateGain) + left feedback from previous period 1642135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} use shift for performance */ 1643135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = SATURATE(nApIn + pReverb->m_nRevFbkL); 1644135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = MULT_EG1_EG1(nApIn, pReverb->m_nLateGain); 1645135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1646135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch allpass delay line out 1647135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1648135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sAp1.m_zApOut, pReverb->m_nBufferMask); 1649135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = pReverb->m_nDelayLine[nAddr]; 1650135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1651135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate allpass feedforward; subtract the feedforward result 1652135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nApIn, pReverb->m_sAp1.m_nApGain); 1653135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApOut = SATURATE(nDelayOut1 - nTemp1); // allpass output 1654135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1655135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate allpass feedback; add the feedback result 1656135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nApOut, pReverb->m_sAp1.m_nApGain); 1657135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = SATURATE(nApIn + nTemp1); 1658135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1659135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // inject into allpass delay 1660135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1661135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sAp1.m_zApIn, pReverb->m_nBufferMask); 1662135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nTemp1; 1663135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1664135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // inject allpass output into delay line 1665135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD1In, pReverb->m_nBufferMask); 1666135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nApOut; 1667135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1668135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** Right Allpass - end 1669135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1670135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** D0 output - start 1671135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line self out 1672135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD0Self, pReverb->m_nBufferMask); 1673135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = pReverb->m_nDelayLine[nAddr]; 1674135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1675135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate delay line self out 1676135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut0, pReverb->m_nSin); 1677135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1678135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line cross out 1679135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD1Cross, pReverb->m_nBufferMask); 1680135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = pReverb->m_nDelayLine[nAddr]; 1681135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1682135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate delay line self out 1683135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(nDelayOut0, pReverb->m_nCos); 1684135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1685135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate unfiltered delay out 1686135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = SATURATE(nTemp1 + nTemp2); 1687135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1688135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** D0 output - end 1689135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1690135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** D1 output - start 1691135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line self out 1692135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD1Self, pReverb->m_nBufferMask); 1693135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = pReverb->m_nDelayLine[nAddr]; 1694135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1695135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate delay line self out 1696135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut1, pReverb->m_nSin); 1697135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1698135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line cross out 1699135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD0Cross, pReverb->m_nBufferMask); 1700135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = pReverb->m_nDelayLine[nAddr]; 1701135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1702135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate delay line self out 1703135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(nDelayOut1, pReverb->m_nCos); 1704135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1705135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate unfiltered delay out 1706135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = SATURATE(nTemp1 + nTemp2); 1707135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1708135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** D1 output - end 1709135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1710135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** mixer and feedback - start 1711135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // sum is fedback to right input (R + L) 1712135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = (short) SATURATE(nDelayOut0 + nDelayOut1); 1713135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1714135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // difference is feedback to left input (R - L) 1715135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{685} lint complains that it can't saturate negative */ 1716135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = (short) SATURATE(nDelayOut1 - nDelayOut0); 1717135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1718135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** mixer and feedback - end 1719135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1720135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate lowpass filter (mixer scale factor included in LPF feedforward) 1721135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut0, pReverb->m_nRvbLpfFwd); 1722135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1723135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(pReverb->m_nRevFbkL, pReverb->m_nRvbLpfFbk); 1724135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1725135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate filtered delay out and simultaneously update LPF state variable 1726135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // filtered delay output is stored in m_nRevFbkL 1727135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRevFbkL = (short) SATURATE(nTemp1 + nTemp2); 1728135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1729135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate lowpass filter (mixer scale factor included in LPF feedforward) 1730135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut1, pReverb->m_nRvbLpfFwd); 1731135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1732135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(pReverb->m_nRevFbkR, pReverb->m_nRvbLpfFbk); 1733135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1734135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate filtered delay out and simultaneously update LPF state variable 1735135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // filtered delay output is stored in m_nRevFbkR 1736135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRevFbkR = (short) SATURATE(nTemp1 + nTemp2); 1737135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1738135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** start early reflection generator, left 1739135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //psEarly = &(pReverb->m_sEarlyL); 1740135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1741135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1742135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (j = 0; j < REVERB_MAX_NUM_REFLECTIONS; j++) { 1743135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line out 1744135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //nAddr = CIRCULAR(nBase, psEarly->m_zDelay[j], pReverb->m_nBufferMask); 1745135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1746135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sEarlyL.m_zDelay[j], pReverb->m_nBufferMask); 1747135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1748135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = pReverb->m_nDelayLine[nAddr]; 1749135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1750135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate reflection 1751135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //nTemp1 = MULT_EG1_EG1(nDelayOut0, psEarly->m_nGain[j]); 1752135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nTemp1, pReverb->m_sEarlyL.m_nGain[j]); 1753135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1754135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = SATURATE(nDelayOut0 + nTemp1); 1755135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1756135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } // end for (j=0; j < REVERB_MAX_NUM_REFLECTIONS; j++) 1757135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1758135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // apply lowpass to early reflections and reverb output 1759135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //nTemp1 = MULT_EG1_EG1(nEarlyOut, psEarly->m_nRvbLpfFwd); 1760135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut0, pReverb->m_nRoomLpfFwd); 1761135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1762135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //nTemp2 = MULT_EG1_EG1(psEarly->m_zLpf, psEarly->m_nLpfFbk); 1763135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(pReverb->m_zOutLpfL, pReverb->m_nRoomLpfFbk); 1764135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1765135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate filtered out and simultaneously update LPF state variable 1766135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // filtered output is stored in m_zOutLpfL 1767135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zOutLpfL = (short) SATURATE(nTemp1 + nTemp2); 1768135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1769135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //sum with output buffer 1770135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent tempValue = *pOutputBuffer; 1771135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pOutputBuffer++ = (short) SATURATE(tempValue+pReverb->m_zOutLpfL); 1772135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1773135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** end early reflection generator, left 1774135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1775135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** start early reflection generator, right 1776135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //psEarly = &(pReverb->m_sEarlyR); 1777135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1778135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (j = 0; j < REVERB_MAX_NUM_REFLECTIONS; j++) { 1779135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line out 1780135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1781135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sEarlyR.m_zDelay[j], pReverb->m_nBufferMask); 1782135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = pReverb->m_nDelayLine[nAddr]; 1783135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1784135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate reflection 1785135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nTemp1, pReverb->m_sEarlyR.m_nGain[j]); 1786135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1787135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = SATURATE(nDelayOut1 + nTemp1); 1788135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1789135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } // end for (j=0; j < REVERB_MAX_NUM_REFLECTIONS; j++) 1790135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1791135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // apply lowpass to early reflections 1792135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut1, pReverb->m_nRoomLpfFwd); 1793135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1794135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(pReverb->m_zOutLpfR, pReverb->m_nRoomLpfFbk); 1795135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1796135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate filtered out and simultaneously update LPF state variable 1797135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // filtered output is stored in m_zOutLpfR 1798135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zOutLpfR = (short) SATURATE(nTemp1 + nTemp2); 1799135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1800135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //sum with output buffer 1801135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent tempValue = *pOutputBuffer; 1802135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pOutputBuffer++ = (short) SATURATE(tempValue + pReverb->m_zOutLpfR); 1803135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1804135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** end early reflection generator, right 1805135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1806135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // decrement base addr for next sample period 1807135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nBase--; 1808135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1809135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSin += pReverb->m_nSinIncrement; 1810135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCos += pReverb->m_nCosIncrement; 1811135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1812135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } // end for (i=0; i < nNumSamplesToAdd; i++) 1813135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1814135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // store the most up to date version 1815135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nBaseIndex = nBase; 1816135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1817135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 1818135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end Reverb */ 1819135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1820135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1821135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ReverbUpdateRoom 1822135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1823135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 1824135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Update the room's preset parameters as required 1825135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1826135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1827135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1828135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1829135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1830135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1831135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 1832135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * - reverb paramters (fbk, fwd, etc) will be changed 1833135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * - m_nCurrentRoom := m_nNextRoom 1834135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1835135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1836135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int ReverbUpdateRoom(reverb_object_t *pReverb, bool fullUpdate) { 1837135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int temp; 1838135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int i; 1839135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int maxSamples; 1840135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int earlyDelay; 1841135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int earlyGain; 1842135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1843135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_preset_t *pPreset = 1844135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent &pReverb->m_sPreset.m_sPreset[pReverb->m_nNextRoom]; 1845135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1846135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (fullUpdate) { 1847135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRvbLpfFwd = pPreset->m_nRvbLpfFwd; 1848135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRvbLpfFbk = pPreset->m_nRvbLpfFbk; 1849135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1850135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nEarlyGain = pPreset->m_nEarlyGain; 1851135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to sample based 1852135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nLateGain = pPreset->m_nLateGain; 1853135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRoomLpfFbk = pPreset->m_nRoomLpfFbk; 1854135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRoomLpfFwd = pPreset->m_nRoomLpfFwd; 1855135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1856135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // set the early reflections gains 1857135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent earlyGain = pPreset->m_nEarlyGain; 1858135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; i < REVERB_MAX_NUM_REFLECTIONS; i++) { 1859135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyL.m_nGain[i] 1860135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = MULT_EG1_EG1(pPreset->m_sEarlyL.m_nGain[i],earlyGain); 1861135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyR.m_nGain[i] 1862135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = MULT_EG1_EG1(pPreset->m_sEarlyR.m_nGain[i],earlyGain); 1863135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1864135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1865135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nMaxExcursion = pPreset->m_nMaxExcursion; 1866135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1867135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp0.m_nApGain = pPreset->m_nAp0_ApGain; 1868135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp1.m_nApGain = pPreset->m_nAp1_ApGain; 1869135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1870135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // set the early reflections delay 1871135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent earlyDelay = ((int) pPreset->m_nEarlyDelay * pReverb->m_nSamplingRate) 1872135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16; 1873135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nEarlyDelay = earlyDelay; 1874135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxSamples = (int32_t) (MAX_EARLY_TIME * pReverb->m_nSamplingRate) 1875135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16; 1876135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; i < REVERB_MAX_NUM_REFLECTIONS; i++) { 1877135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to sample based 1878135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = earlyDelay + (((int) pPreset->m_sEarlyL.m_zDelay[i] 1879135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb->m_nSamplingRate) >> 16); 1880135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > maxSamples) 1881135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples; 1882135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyL.m_zDelay[i] = pReverb->m_nEarly0in + temp; 1883135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to sample based 1884135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = earlyDelay + (((int) pPreset->m_sEarlyR.m_zDelay[i] 1885135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb->m_nSamplingRate) >> 16); 1886135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > maxSamples) 1887135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples; 1888135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyR.m_zDelay[i] = pReverb->m_nEarly1in + temp; 1889135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1890135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1891135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxSamples = (int32_t) (MAX_DELAY_TIME * pReverb->m_nSamplingRate) 1892135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16; 1893135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to sample based 1894135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1895135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (pPreset->m_nLateDelay * pReverb->m_nSamplingRate) >> 16; 1896135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if ((temp + pReverb->m_nMaxExcursion) > maxSamples) { 1897135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples - pReverb->m_nMaxExcursion; 1898135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1899135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp -= pReverb->m_nLateDelay; 1900135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelay0Out += temp; 1901135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelay1Out += temp; 1902135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nLateDelay += temp; 1903135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1904135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxSamples = (int32_t) (MAX_AP_TIME * pReverb->m_nSamplingRate) >> 16; 1905135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to absolute sample value 1906135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = pPreset->m_nAp0_ApOut; 1907135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1908135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1909135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > maxSamples) 1910135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples; 1911135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp0.m_zApOut = (uint16_t) (pReverb->m_sAp0.m_zApIn + temp); 1912135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1913135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to absolute sample value 1914135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = pPreset->m_nAp1_ApOut; 1915135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1916135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1917135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > maxSamples) 1918135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples; 1919135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp1.m_zApOut = (uint16_t) (pReverb->m_sAp1.m_zApIn + temp); 1920135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //gpsReverbObject->m_sAp1.m_zApOut = pPreset->m_nAp1_ApOut; 1921135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1922135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1923135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to sample based 1924135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = pPreset->m_nXfadeInterval; 1925135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1926135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1927135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nXfadeInterval = (uint16_t) temp; 1928135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //gsReverbObject.m_nXfadeInterval = pPreset->m_nXfadeInterval; 1929135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nXfadeCounter = pReverb->m_nXfadeInterval + 1; // force update on first iteration 1930135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1931135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCurrentRoom = pReverb->m_nNextRoom; 1932135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1933135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 1934135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1935135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end ReverbUpdateRoom */ 1936135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1937135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1938135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ReverbReadInPresets() 1939135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1940135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: sets global reverb preset bank to defaults 1941135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1942135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1943135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1944135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1945135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1946135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1947135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1948135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int ReverbReadInPresets(reverb_object_t *pReverb) { 1949135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1950cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent int preset; 1951135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1952cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // this is for test only. OpenSL ES presets are mapped to 4 presets. 1953cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent // REVERB_PRESET_NONE is mapped to bypass 1954cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent for (preset = 0; preset < REVERB_NUM_PRESETS; preset++) { 1955cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent reverb_preset_t *pPreset = &pReverb->m_sPreset.m_sPreset[preset]; 1956cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent switch (preset + 1) { 1957cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PRESET_PLATE: 1958cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PRESET_SMALLROOM: 1959cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRvbLpfFbk = 5077; 1960cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRvbLpfFwd = 11076; 1961135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyGain = 27690; 1962135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyDelay = 1311; 1963135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateGain = 8191; 1964135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateDelay = 3932; 1965135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFbk = 3692; 1966cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRoomLpfFwd = 20474; 1967135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[0] = 1376; 1968135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[0] = 22152; 1969cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_sEarlyL.m_zDelay[1] = 1462; 1970135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[1] = 17537; 1971135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[2] = 0; 1972135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[2] = 14768; 1973135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[3] = 1835; 1974135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[3] = 14307; 1975135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[4] = 0; 1976135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[4] = 13384; 1977135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[0] = 721; 1978135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[0] = 20306; 1979135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[1] = 2621; 1980135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[1] = 17537; 1981135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[2] = 0; 1982135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[2] = 14768; 1983135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[3] = 0; 1984135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[3] = 16153; 1985135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[4] = 0; 1986135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[4] = 13384; 1987135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nMaxExcursion = 127; 1988cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nXfadeInterval = 6470; //6483; 1989cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp0_ApGain = 14768; 1990cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp0_ApOut = 792; 1991cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp1_ApGain = 14777; 1992cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp1_ApOut = 1191; 1993135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu4 = 0; 1994135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu5 = 0; 1995135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu6 = 0; 1996135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu7 = 0; 1997135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu8 = 0; 1998135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu9 = 0; 1999135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu10 = 0; 2000cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 2001cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PRESET_MEDIUMROOM: 2002cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PRESET_LARGEROOM: 2003cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRvbLpfFbk = 5077; 2004cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRvbLpfFwd = 12922; 2005135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyGain = 27690; 2006135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyDelay = 1311; 2007135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateGain = 8191; 2008135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateDelay = 3932; 2009135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFbk = 3692; 2010cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRoomLpfFwd = 21703; 2011135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[0] = 1376; 2012135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[0] = 22152; 2013135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[1] = 1462; 2014135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[1] = 17537; 2015135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[2] = 0; 2016135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[2] = 14768; 2017135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[3] = 1835; 2018135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[3] = 14307; 2019135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[4] = 0; 2020135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[4] = 13384; 2021135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[0] = 721; 2022135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[0] = 20306; 2023135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[1] = 2621; 2024135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[1] = 17537; 2025135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[2] = 0; 2026135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[2] = 14768; 2027135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[3] = 0; 2028135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[3] = 16153; 2029135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[4] = 0; 2030135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[4] = 13384; 2031135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nMaxExcursion = 127; 2032cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nXfadeInterval = 6449; 2033cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp0_ApGain = 15691; 2034cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp0_ApOut = 774; 2035cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp1_ApGain = 16317; 2036cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp1_ApOut = 1155; 2037135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu4 = 0; 2038135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu5 = 0; 2039135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu6 = 0; 2040135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu7 = 0; 2041135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu8 = 0; 2042135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu9 = 0; 2043135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu10 = 0; 2044cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 2045cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PRESET_MEDIUMHALL: 2046cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRvbLpfFbk = 6461; 2047cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRvbLpfFwd = 14307; 2048135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyGain = 27690; 2049135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyDelay = 1311; 2050135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateGain = 8191; 2051135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateDelay = 3932; 2052135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFbk = 3692; 2053cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRoomLpfFwd = 24569; 2054135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[0] = 1376; 2055135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[0] = 22152; 2056135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[1] = 1462; 2057135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[1] = 17537; 2058135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[2] = 0; 2059135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[2] = 14768; 2060135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[3] = 1835; 2061135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[3] = 14307; 2062135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[4] = 0; 2063135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[4] = 13384; 2064135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[0] = 721; 2065135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[0] = 20306; 2066135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[1] = 2621; 2067135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[1] = 17537; 2068135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[2] = 0; 2069135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[2] = 14768; 2070135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[3] = 0; 2071135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[3] = 16153; 2072135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[4] = 0; 2073135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[4] = 13384; 2074135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nMaxExcursion = 127; 2075cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nXfadeInterval = 6391; 2076cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp0_ApGain = 15230; 2077cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp0_ApOut = 708; 2078cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp1_ApGain = 15547; 2079cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp1_ApOut = 1023; 2080135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu4 = 0; 2081135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu5 = 0; 2082135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu6 = 0; 2083135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu7 = 0; 2084135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu8 = 0; 2085135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu9 = 0; 2086135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu10 = 0; 2087cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 2088cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent case REVERB_PRESET_LARGEHALL: 2089cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRvbLpfFbk = 8307; 2090cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRvbLpfFwd = 14768; 2091135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyGain = 27690; 2092135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyDelay = 1311; 2093135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateGain = 8191; 2094135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateDelay = 3932; 2095135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFbk = 3692; 2096cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nRoomLpfFwd = 24569; 2097135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[0] = 1376; 2098135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[0] = 22152; 2099cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_sEarlyL.m_zDelay[1] = 2163; 2100135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[1] = 17537; 2101135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[2] = 0; 2102135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[2] = 14768; 2103135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[3] = 1835; 2104135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[3] = 14307; 2105135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[4] = 0; 2106135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[4] = 13384; 2107135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[0] = 721; 2108135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[0] = 20306; 2109135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[1] = 2621; 2110135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[1] = 17537; 2111135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[2] = 0; 2112135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[2] = 14768; 2113135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[3] = 0; 2114135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[3] = 16153; 2115135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[4] = 0; 2116135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[4] = 13384; 2117135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nMaxExcursion = 127; 2118cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nXfadeInterval = 6388; 2119cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp0_ApGain = 15691; 2120cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp0_ApOut = 711; 2121cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp1_ApGain = 16317; 2122cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent pPreset->m_nAp1_ApOut = 1029; 2123135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu4 = 0; 2124135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu5 = 0; 2125135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu6 = 0; 2126135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu7 = 0; 2127135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu8 = 0; 2128135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu9 = 0; 2129135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu10 = 0; 2130cb28102ad3976339ec445afbcb4130f2991b38d7Eric Laurent break; 2131135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 2132135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 2133135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 2134135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 2135135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 2136