EffectReverb.c revision be916aa1267e2e6b1c148f51d11bcbbc79cb864c
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" 18135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// 19135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#define LOG_NDEBUG 0 20135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include <cutils/log.h> 21be916aa1267e2e6b1c148f51d11bcbbc79cb864cEric Laurent#include <stdlib.h> 22be916aa1267e2e6b1c148f51d11bcbbc79cb864cEric Laurent#include <string.h> 23135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include <stdbool.h> 24135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "EffectReverb.h" 25135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent#include "EffectsMath.h" 26135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 27135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int gEffectIndex; 28135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 29135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// effect_interface_t interface implementation for reverb effect 30135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentconst struct effect_interface_s gReverbInterface = { 31135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Reverb_Process, 32135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Reverb_Command 33135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 34135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 35135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Google auxiliary environmental reverb UUID: 1f0ae2e0-4ef7-11df-bc09-0002a5d5c51b 36135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const effect_descriptor_t gAuxEnvReverbDescriptor = { 37135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0xc2e5d5f0, 0x94bd, 0x4763, 0x9cac, {0x4e, 0x23, 0x4d, 0x06, 0x83, 0x9e}}, 38135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0x1f0ae2e0, 0x4ef7, 0x11df, 0xbc09, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, 39135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_API_VERSION, 40135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_FLAG_TYPE_AUXILIARY, 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, 51135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Insert Environmental reverb", 52135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Google Inc." 53135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 54135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 55135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Google auxiliary preset reverb UUID: 63909320-53a6-11df-bdbd-0002a5d5c51b 56135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const effect_descriptor_t gAuxPresetReverbDescriptor = { 57135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0x47382d60, 0xddd8, 0x4763, 0x11db, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, 58135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0x63909320, 0x53a6, 0x11df, 0xbdbd, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, 59135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_API_VERSION, 60135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_FLAG_TYPE_AUXILIARY, 61135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Aux Preset Reverb", 62135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Google Inc." 63135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 64135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 65135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// Google insert preset reverb UUID: d93dc6a0-6342-11df-b128-0002a5d5c51b 66135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const effect_descriptor_t gInsertPresetReverbDescriptor = { 67135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0x47382d60, 0xddd8, 0x4763, 0x11db, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, 68135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent {0xd93dc6a0, 0x6342, 0x11df, 0xb128, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}}, 69135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_API_VERSION, 70135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent EFFECT_FLAG_TYPE_INSERT | EFFECT_FLAG_INSERT_FIRST, 71135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Insert Preset Reverb", 72135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent "Google Inc." 73135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 74135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 75135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent// gDescriptors contains pointers to all defined effect descriptor in this library 76135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic const effect_descriptor_t * const gDescriptors[] = { 77135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent &gAuxEnvReverbDescriptor, 78135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent &gInsertEnvReverbDescriptor, 79135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent &gAuxPresetReverbDescriptor, 80135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent &gInsertPresetReverbDescriptor, 81135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent NULL 82135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent}; 83135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 84135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 85135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Effect API implementation 86135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *--------------------------------------------------------------------------*/ 87135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 88135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*--- Effect Library Interface Implementation ---*/ 89135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 90be916aa1267e2e6b1c148f51d11bcbbc79cb864cEric Laurentint EffectQueryNumberEffects(uint32_t *pNumEffects) { 91135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pNumEffects = sizeof(gDescriptors) / sizeof(const effect_descriptor_t *) 92135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - 1; 93135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent gEffectIndex = 0; 94135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 95135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 96135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 97135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint EffectQueryNext(effect_descriptor_t *pDescriptor) { 98135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pDescriptor == NULL) { 99135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 100135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 101135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (gDescriptors[gEffectIndex] == NULL) { 102135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -ENOENT; 103135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 104135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent memcpy(pDescriptor, gDescriptors[gEffectIndex++], 105135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent sizeof(effect_descriptor_t)); 106135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 107135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 108135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 109135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint EffectCreate(effect_uuid_t *uuid, 110135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent effect_interface_t *pInterface) { 111135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int ret; 112135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int i; 113135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_module_t *module; 114135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent const effect_descriptor_t *desc; 115135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int aux = 0; 116135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int preset = 0; 117135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 118135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("EffectLibCreateEffect start"); 119135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 120135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pInterface == NULL || uuid == NULL) { 121135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 122135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 123135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 124135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; gDescriptors[i] != NULL; i++) { 125135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent desc = gDescriptors[i]; 126135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (memcmp(uuid, &desc->uuid, sizeof(effect_uuid_t)) 127135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent == 0) { 128135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 129135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 130135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 131135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 132135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (gDescriptors[i] == NULL) { 133135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -ENOENT; 134135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 135135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 136135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent module = malloc(sizeof(reverb_module_t)); 137135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 138135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent module->itfe = &gReverbInterface; 139135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 140135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (memcmp(&desc->type, SL_IID_PRESETREVERB, sizeof(effect_uuid_t)) == 0) { 141135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent preset = 1; 142135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 143135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if ((desc->flags & EFFECT_FLAG_TYPE_MASK) == EFFECT_FLAG_TYPE_AUXILIARY) { 144135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent aux = 1; 145135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 146135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ret = Reverb_Init(module, aux, preset); 147135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (ret < 0) { 148135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGW("EffectLibCreateEffect() init failed"); 149135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent free(module); 150135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return ret; 151135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 152135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 153135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pInterface = (effect_interface_t) module; 154135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 155135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("EffectLibCreateEffect %p", module); 156135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 157135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 158135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 159135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 160135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint EffectRelease(effect_interface_t interface) { 161135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_module_t *pRvbModule = (reverb_module_t *)interface; 162135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 163135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("EffectLibReleaseEffect %p", interface); 164135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (interface == NULL) { 165135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 166135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 167135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 168135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent free(pRvbModule); 169135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 170135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 171135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 172135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 173135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*--- Effect Control Interface Implementation ---*/ 174135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 175135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int Reverb_Process(effect_interface_t self, audio_buffer_t *inBuffer, audio_buffer_t *outBuffer) { 176135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_object_t *pReverb; 177135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t *pSrc, *pDst; 178135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_module_t *pRvbModule = (reverb_module_t *)self; 179135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 180135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pRvbModule == NULL) { 181135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 182135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 183135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 184135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (inBuffer == NULL || inBuffer->raw == NULL || 185135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent outBuffer == NULL || outBuffer->raw == NULL || 186135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent inBuffer->frameCount != outBuffer->frameCount) { 187135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 188135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 189135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 190135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb = (reverb_object_t*) &pRvbModule->context; 191135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 192135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //if bypassed or the preset forces the signal to be completely dry 193135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_bBypass) { 194135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (inBuffer->raw != outBuffer->raw && !pReverb->m_Aux) { 195135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent memcpy(outBuffer->raw, inBuffer->raw, outBuffer->frameCount * NUM_OUTPUT_CHANNELS * sizeof(int16_t)); 196135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 197135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 198135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 199135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 200135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_nNextRoom != pReverb->m_nCurrentRoom) { 201135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ReverbUpdateRoom(pReverb, true); 202135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 203135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 204135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pSrc = inBuffer->s16; 205135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pDst = outBuffer->s16; 206135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent size_t numSamples = outBuffer->frameCount; 207135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent while (numSamples) { 208135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint32_t processedSamples; 209135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (numSamples > (uint32_t) pReverb->m_nUpdatePeriodInSamples) { 210135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent processedSamples = (uint32_t) pReverb->m_nUpdatePeriodInSamples; 211135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 212135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent processedSamples = numSamples; 213135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 214135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 215135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* increment update counter */ 216135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdateCounter += (int16_t) processedSamples; 217135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* check if update counter needs to be reset */ 218135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_nUpdateCounter >= pReverb->m_nUpdatePeriodInSamples) { 219135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* update interval has elapsed, so reset counter */ 220135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdateCounter -= pReverb->m_nUpdatePeriodInSamples; 221135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ReverbUpdateXfade(pReverb, pReverb->m_nUpdatePeriodInSamples); 222135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 223135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } /* end if m_nUpdateCounter >= update interval */ 224135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 225135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Reverb(pReverb, processedSamples, pDst, pSrc); 226135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 227135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent numSamples -= processedSamples; 228135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_Aux) { 229135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pDst += processedSamples; 230135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 231135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pSrc += processedSamples * NUM_OUTPUT_CHANNELS; 232135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 233135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 234135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 235135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 236135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 237135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 238135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int Reverb_Command(effect_interface_t self, int cmdCode, int cmdSize, 239135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent void *pCmdData, int *replySize, void *pReplyData) { 240135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_module_t *pRvbModule = (reverb_module_t *) self; 241135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_object_t *pReverb; 242135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int retsize; 243135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 244135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pRvbModule == NULL) { 245135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 246135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 247135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 248135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb = (reverb_object_t*) &pRvbModule->context; 249135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 250135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Command command %d cmdSize %d",cmdCode, cmdSize); 251135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 252135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (cmdCode) { 253135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_INIT: 254135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReplyData == NULL || *replySize != sizeof(int)) { 255135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 256135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 257135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int *) pReplyData = Reverb_Init(pRvbModule, pReverb->m_Aux, pReverb->m_Preset); 258135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 259135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_CONFIGURE: 260135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pCmdData == NULL || cmdSize != sizeof(effect_config_t) 261135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent || pReplyData == NULL || *replySize != sizeof(int)) { 262135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 263135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 264135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int *) pReplyData = Reverb_Configure(pRvbModule, 265135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent (effect_config_t *)pCmdData, false); 266135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 267135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_RESET: 268135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Reverb_Reset(pReverb, false); 269135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 270135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_GET_PARAM: 271135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Command EFFECT_CMD_GET_PARAM pCmdData %p, *replySize %d, pReplyData: %p",pCmdData, *replySize, pReplyData); 272135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 273135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pCmdData == NULL || cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t)) || 274135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReplyData == NULL || *replySize < (int) sizeof(effect_param_t)) { 275135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 276135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 277135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent effect_param_t *rep = (effect_param_t *) pReplyData; 278135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent memcpy(pReplyData, pCmdData, sizeof(effect_param_t) + sizeof(int32_t)); 279135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Command EFFECT_CMD_GET_PARAM param %d, replySize %d",*(int32_t *)rep->data, rep->vsize); 280135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent rep->status = Reverb_getParameter(pReverb, *(int32_t *)rep->data, &rep->vsize, 281135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent rep->data + sizeof(int32_t)); 282135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *replySize = sizeof(effect_param_t) + sizeof(int32_t) + rep->vsize; 283135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 284135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case EFFECT_CMD_SET_PARAM: 285135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Command EFFECT_CMD_SET_PARAM cmdSize %d pCmdData %p, *replySize %d, pReplyData %p", 286135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent cmdSize, pCmdData, *replySize, pReplyData); 287135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pCmdData == NULL || (cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t))) 288135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent || pReplyData == NULL || *replySize != (int)sizeof(int32_t)) { 289135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 290135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 291135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent effect_param_t *cmd = (effect_param_t *) pCmdData; 292135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int *)pReplyData = Reverb_setParameter(pReverb, *(int32_t *)cmd->data, 293135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent cmd->vsize, cmd->data + sizeof(int32_t)); 294135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 295135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 296135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGW("Reverb_Command invalid command %d",cmdCode); 297135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 298135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 299135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 300135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 301135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 302135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 303135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 304135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 305135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb internal functions 306135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *--------------------------------------------------------------------------*/ 307135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 308135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 309135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb_Init() 310135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 311135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 312135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Initialize reverb context and apply default parameters 313135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 314135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 315135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pRvbModule - pointer to reverb effect module 316135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * aux - indicates if the reverb is used as auxiliary (1) or insert (0) 317135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * preset - indicates if the reverb is used in preset (1) or environmental (0) mode 318135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 319135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 320135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 321135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 322135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 323135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 324135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 325135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 326135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Reverb_Init(reverb_module_t *pRvbModule, int aux, int preset) { 327135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int ret; 328135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 329135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Init module %p, aux: %d, preset: %d", pRvbModule,aux, preset); 330135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 331135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent memset(&pRvbModule->context, 0, sizeof(reverb_object_t)); 332135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 333135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->context.m_Aux = (uint16_t)aux; 334135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->context.m_Preset = (uint16_t)preset; 335135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 336135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.samplingRate = 44100; 337135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (aux) { 338135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.channels = CHANNEL_MONO; 339135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 340135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.channels = CHANNEL_STEREO; 341135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 342135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.format = PCM_FORMAT_S15; 343135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.bufferProvider.getBuffer = NULL; 344135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.bufferProvider.releaseBuffer = NULL; 345135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.bufferProvider.cookie = NULL; 346135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ; 347135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.inputCfg.mask = EFFECT_CONFIG_ALL; 348135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.samplingRate = 44100; 349135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.channels = CHANNEL_STEREO; 350135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.format = PCM_FORMAT_S15; 351135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.bufferProvider.getBuffer = NULL; 352135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.bufferProvider.releaseBuffer = NULL; 353135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.bufferProvider.cookie = NULL; 354135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_ACCUMULATE; 355135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pRvbModule->config.outputCfg.mask = EFFECT_CONFIG_ALL; 356135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 357135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ret = Reverb_Configure(pRvbModule, &pRvbModule->config, true); 358135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (ret < 0) { 359135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Init error %d on module %p", ret, pRvbModule); 360135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 361135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 362135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return ret; 363135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 364135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 365135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 366135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb_Init() 367135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 368135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 369135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Set input and output audio configuration. 370135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 371135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 372135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pRvbModule - pointer to reverb effect module 373135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pConfig - pointer to effect_config_t structure containing input 374135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * and output audio parameters configuration 375135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * init - true if called from init function 376135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 377135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 378135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 379135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 380135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 381135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 382135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 383135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Reverb_Configure(reverb_module_t *pRvbModule, effect_config_t *pConfig, 384135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bool init) { 385135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_object_t *pReverb = &pRvbModule->context; 386135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int bufferSizeInSamples; 387135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int updatePeriodInSamples; 388135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int xfadePeriodInSamples; 389135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 390135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Check configuration compatibility with build options 391135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pConfig->inputCfg.samplingRate 392135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent != pConfig->outputCfg.samplingRate 393135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent || pConfig->outputCfg.channels != OUTPUT_CHANNELS 394135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent || pConfig->inputCfg.format != PCM_FORMAT_S15 395135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent || pConfig->outputCfg.format != PCM_FORMAT_S15) { 396135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Configure invalid config"); 397135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 398135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 399135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if ((pReverb->m_Aux && (pConfig->inputCfg.channels != CHANNEL_MONO)) || 400135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent (!pReverb->m_Aux && (pConfig->inputCfg.channels != CHANNEL_STEREO))) { 401135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Configure invalid config"); 402135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 403135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 404135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 405135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent memcpy(&pRvbModule->config, pConfig, sizeof(effect_config_t)); 406135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 407135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSamplingRate = pRvbModule->config.outputCfg.samplingRate; 408135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 409135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (pReverb->m_nSamplingRate) { 410135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 8000: 411135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 5; 412135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 4096; 413135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = -23170; 414135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 415135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 16000: 416135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 6; 417135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 8192; 418135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = -12540; 419135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 420135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 22050: 421135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 7; 422135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 8192; 423135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = 4768; 424135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 425135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 32000: 426135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 7; 427135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 16384; 428135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = 18205; 429135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 430135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 44100: 431135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 8; 432135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 16384; 433135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = 24799; 434135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 435135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case 48000: 436135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInBits = 8; 437135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent bufferSizeInSamples = 16384; 438135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosWT_5KHz = 25997; 439135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 440135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 441135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_Configure invalid sampling rate %d", pReverb->m_nSamplingRate); 442135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 443135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 444135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 445135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Define a mask for circular addressing, so that array index 446135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // can wraparound and stay in array boundary of 0, 1, ..., (buffer size -1) 447135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // The buffer size MUST be a power of two 448135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nBufferMask = (int32_t) (bufferSizeInSamples - 1); 449135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* reverb parameters are updated every 2^(pReverb->m_nUpdatePeriodInBits) samples */ 450135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent updatePeriodInSamples = (int32_t) (0x1L << pReverb->m_nUpdatePeriodInBits); 451135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* 452135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent calculate the update counter by bitwise ANDING with this value to 453135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent generate a 2^n modulo value 454135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 455135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdatePeriodInSamples = (int32_t) updatePeriodInSamples; 456135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 457135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent xfadePeriodInSamples = (int32_t) (REVERB_XFADE_PERIOD_IN_SECONDS 458135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * (double) pReverb->m_nSamplingRate); 459135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 460135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // set xfade parameters 461135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhaseIncrement 462135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = (int16_t) (65536 / ((int16_t) xfadePeriodInSamples 463135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent / (int16_t) updatePeriodInSamples)); 464135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 465135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (init) { 466135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ReverbReadInPresets(pReverb); 467135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 468135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // for debugging purposes, allow noise generator 469135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_bUseNoise = true; 470135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 471135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // for debugging purposes, allow bypass 472135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_bBypass = false; 473135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 474135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nNextRoom = 1; 475135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 476135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nNoise = (int16_t) 0xABCD; 477135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 478135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 479135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Reverb_Reset(pReverb, init); 480135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 481135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 482135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 483135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 484135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 485135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb_Reset() 486135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 487135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 488135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reset internal states and clear delay lines. 489135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 490135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 491135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb - pointer to reverb context 492135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * init - true if called from init function 493135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 494135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 495135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 496135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 497135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 498135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 499135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 500135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 501135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentvoid Reverb_Reset(reverb_object_t *pReverb, bool init) { 502135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int bufferSizeInSamples = (int32_t) (pReverb->m_nBufferMask + 1); 503135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int maxApSamples; 504135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int maxDelaySamples; 505135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int maxEarlySamples; 506135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int ap1In; 507135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int delay0In; 508135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int delay1In; 509135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t i; 510135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint16_t nOffset; 511135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 512135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxApSamples = ((int32_t) (MAX_AP_TIME * pReverb->m_nSamplingRate) >> 16); 513135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxDelaySamples = ((int32_t) (MAX_DELAY_TIME * pReverb->m_nSamplingRate) 514135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16); 515135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxEarlySamples = ((int32_t) (MAX_EARLY_TIME * pReverb->m_nSamplingRate) 516135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16); 517135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 518135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ap1In = (AP0_IN + maxApSamples + GUARD); 519135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent delay0In = (ap1In + maxApSamples + GUARD); 520135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent delay1In = (delay0In + maxDelaySamples + GUARD); 521135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Define the max offsets for the end points of each section 522135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // i.e., we don't expect a given section's taps to go beyond 523135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // the following limits 524135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 525135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nEarly0in = (delay1In + maxDelaySamples + GUARD); 526135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nEarly1in = (pReverb->m_nEarly0in + maxEarlySamples + GUARD); 527135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 528135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp0.m_zApIn = AP0_IN; 529135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 530135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD0In = delay0In; 531135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 532135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp1.m_zApIn = ap1In; 533135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 534135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD1In = delay1In; 535135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 536135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zOutLpfL = 0; 537135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zOutLpfR = 0; 538135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 539135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRevFbkR = 0; 540135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRevFbkL = 0; 541135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 542135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // set base index into circular buffer 543135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nBaseIndex = 0; 544135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 545135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // clear the reverb delay line 546135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; i < bufferSizeInSamples; i++) { 547135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[i] = 0; 548135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 549135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 550135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ReverbUpdateRoom(pReverb, init); 551135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 552135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nUpdateCounter = 0; 553135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 554135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhase = -32768; 555135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 556135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSin = 0; 557135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCos = 0; 558135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSinIncrement = 0; 559135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosIncrement = 0; 560135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 561135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // set delay tap lengths 562135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 563135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 564135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD1Cross = pReverb->m_nDelay1Out - pReverb->m_nMaxExcursion 565135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent + nOffset; 566135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 567135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 568135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 569135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD0Cross = pReverb->m_nDelay0Out - pReverb->m_nMaxExcursion 570135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - nOffset; 571135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 572135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 573135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 574135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD0Self = pReverb->m_nDelay0Out - pReverb->m_nMaxExcursion 575135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - nOffset; 576135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 577135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 578135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 579135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD1Self = pReverb->m_nDelay1Out - pReverb->m_nMaxExcursion 580135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent + nOffset; 581135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 582135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 583135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 584135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb_getParameter() 585135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 586135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 587135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Get a Reverb parameter 588135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 589135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 590135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb - handle to instance data 591135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * param - parameter 592135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pValue - pointer to variable to hold retrieved value 593135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pSize - pointer to value size: maximum size as input 594135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 595135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 596135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * *pValue updated with parameter value 597135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * *pSize updated with actual value size 598135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 599135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 600135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 601135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 602135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 603135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 604135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Reverb_getParameter(reverb_object_t *pReverb, int32_t param, size_t *pSize, 605135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent void *pValue) { 606135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t *pValue32; 607135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t *pValue16; 608135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent t_reverb_properties *pProperties; 609135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t i; 610135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t temp; 611135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t temp2; 612135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent size_t size; 613135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 614135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_Preset && param != REVERB_PARAM_PRESET) { 615135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 616135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 617135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (!pReverb->m_Preset && param == REVERB_PARAM_PRESET) { 618135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 619135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 620135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 621135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (param) { 622135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_ROOM_LEVEL: 623135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_ROOM_HF_LEVEL: 624135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DECAY_HF_RATIO: 625135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REFLECTIONS_LEVEL: 626135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REVERB_LEVEL: 627135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DIFFUSION: 628135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DENSITY: 629135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent size = sizeof(int16_t); 630135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 631135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 632135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_BYPASS: 633135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_PRESET: 634135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DECAY_TIME: 635135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REFLECTIONS_DELAY: 636135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REVERB_DELAY: 637135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent size = sizeof(int32_t); 638135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 639135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 640135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_PROPERTIES: 641135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent size = sizeof(t_reverb_properties); 642135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 643135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 644135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 645135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 646135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 647135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 648135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (*pSize < size) { 649135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 650135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 651135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pSize = size; 652135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue32 = (int32_t *) pValue; 653135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue16 = (int16_t *) pValue; 654135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pProperties = (t_reverb_properties *) pValue; 655135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 656135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (param) { 657135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_BYPASS: 658135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int32_t *) pValue = (int32_t) pReverb->m_bBypass; 659135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 660135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_PRESET: 661135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *(int32_t *) pValue = (int8_t) pReverb->m_nCurrentRoom; 662135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 663135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 664135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_PROPERTIES: 665135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue16 = &pProperties->roomLevel; 666135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 667135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 668135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_ROOM_LEVEL: 669135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert m_nRoomLpfFwd to millibels 670135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (pReverb->m_nRoomLpfFwd << 15) 671135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent / (32767 - pReverb->m_nRoomLpfFbk); 672135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValue16 = Effects_Linear16ToMillibels(temp); 673135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 674135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_ROOM_LEVEL %d, gain %d, m_nRoomLpfFwd %d, m_nRoomLpfFbk %d", *pValue16, temp, pReverb->m_nRoomLpfFwd, pReverb->m_nRoomLpfFbk); 675135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 676135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_ROOM_LEVEL) { 677135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 678135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 679135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue16 = &pProperties->roomHFLevel; 680135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 681135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 682135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_ROOM_HF_LEVEL: 683135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // The ratio between linear gain at 0Hz and at 5000Hz for the room low pass is: 684135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // (1 + a1) / sqrt(a1^2 + 2*C*a1 + 1) where: 685135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // - a1 is minus the LP feedback gain: -pReverb->m_nRoomLpfFbk 686135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // - C is cos(2piWT) @ 5000Hz: pReverb->m_nCosWT_5KHz 687135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 688135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = MULT_EG1_EG1(pReverb->m_nRoomLpfFbk, pReverb->m_nRoomLpfFbk); 689135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_ROOM_HF_LEVEL, a1^2 %d", temp); 690135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp2 = MULT_EG1_EG1(pReverb->m_nRoomLpfFbk, pReverb->m_nCosWT_5KHz) 691135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent << 1; 692135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_ROOM_HF_LEVEL, 2 Cos a1 %d", temp2); 693135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = 32767 + temp - temp2; 694135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_ROOM_HF_LEVEL, a1^2 + 2 Cos a1 + 1 %d", temp); 695135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = Effects_Sqrt(temp) * 181; 696135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_ROOM_HF_LEVEL, SQRT(a1^2 + 2 Cos a1 + 1) %d", temp); 697135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = ((32767 - pReverb->m_nRoomLpfFbk) << 15) / temp; 698135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 699135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_ROOM_HF_LEVEL, gain %d, m_nRoomLpfFwd %d, m_nRoomLpfFbk %d", temp, pReverb->m_nRoomLpfFwd, pReverb->m_nRoomLpfFbk); 700135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 701135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValue16 = Effects_Linear16ToMillibels(temp); 702135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 703135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_ROOM_HF_LEVEL) { 704135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 705135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 706135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue32 = &pProperties->decayTime; 707135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 708135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 709135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DECAY_TIME: 710135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Calculate reverb feedback path gain 711135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (pReverb->m_nRvbLpfFwd << 15) / (32767 - pReverb->m_nRvbLpfFbk); 712135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = Effects_Linear16ToMillibels(temp); 713135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 714135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Calculate decay time: g = -6000 d/DT , g gain in millibels, d reverb delay, DT decay time 715135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (-6000 * pReverb->m_nLateDelay) / temp; 716135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 717135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert samples to ms 718135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValue32 = (temp * 1000) / pReverb->m_nSamplingRate; 719135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 720135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_DECAY_TIME, samples %d, ms %d", temp, *pValue32); 721135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 722135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_DECAY_TIME) { 723135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 724135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 725135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue16 = &pProperties->decayHFRatio; 726135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 727135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 728135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DECAY_HF_RATIO: 729135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // If r is the decay HF ratio (r = REVERB_PARAM_DECAY_HF_RATIO/1000) we have: 730135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // DT_5000Hz = DT_0Hz * r 731135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // and G_5000Hz = -6000 * d / DT_5000Hz and G_0Hz = -6000 * d / DT_0Hz in millibels so : 732135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // r = G_0Hz/G_5000Hz in millibels 733135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // The linear gain at 5000Hz is b0 / sqrt(a1^2 + 2*C*a1 + 1) where: 734135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // - a1 is minus the LP feedback gain: -pReverb->m_nRvbLpfFbk 735135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // - b0 is the LP forward gain: pReverb->m_nRvbLpfFwd 736135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // - C is cos(2piWT) @ 5000Hz: pReverb->m_nCosWT_5KHz 737135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_nRvbLpfFbk == 0) { 738135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValue16 = 1000; 739135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_DECAY_HF_RATIO, pReverb->m_nRvbLpfFbk == 0, ratio %d", *pValue16); 740135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 741135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = MULT_EG1_EG1(pReverb->m_nRvbLpfFbk, pReverb->m_nRvbLpfFbk); 742135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp2 = MULT_EG1_EG1(pReverb->m_nRvbLpfFbk, pReverb->m_nCosWT_5KHz) 743135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent << 1; 744135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = 32767 + temp - temp2; 745135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = Effects_Sqrt(temp) * 181; 746135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (pReverb->m_nRvbLpfFwd << 15) / temp; 747135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // The linear gain at 0Hz is b0 / (a1 + 1) 748135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp2 = (pReverb->m_nRvbLpfFwd << 15) / (32767 749135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - pReverb->m_nRvbLpfFbk); 750135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 751135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = Effects_Linear16ToMillibels(temp); 752135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp2 = Effects_Linear16ToMillibels(temp2); 753135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_DECAY_HF_RATIO, gain 5KHz %d mB, gain DC %d mB", temp, temp2); 754135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 755135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp == 0) 756135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = 1; 757135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (int16_t) ((1000 * temp2) / temp); 758135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > 1000) 759135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = 1000; 760135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 761135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValue16 = temp; 762135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_DECAY_HF_RATIO, ratio %d", *pValue16); 763135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 764135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 765135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_DECAY_HF_RATIO) { 766135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 767135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 768135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue16 = &pProperties->reflectionsLevel; 769135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 770135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 771135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REFLECTIONS_LEVEL: 772135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValue16 = Effects_Linear16ToMillibels(pReverb->m_nEarlyGain); 773135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 774135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_REFLECTIONS_LEVEL, %d", *pValue16); 775135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_REFLECTIONS_LEVEL) { 776135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 777135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 778135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue32 = &pProperties->reflectionsDelay; 779135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 780135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 781135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REFLECTIONS_DELAY: 782135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // convert samples to ms 783135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValue32 = (pReverb->m_nEarlyDelay * 1000) / pReverb->m_nSamplingRate; 784135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 785135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_REFLECTIONS_DELAY, samples %d, ms %d", pReverb->m_nEarlyDelay, *pValue32); 786135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 787135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_REFLECTIONS_DELAY) { 788135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 789135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 790135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue16 = &pProperties->reverbLevel; 791135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 792135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 793135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REVERB_LEVEL: 794135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert linear gain to millibels 795135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValue16 = Effects_Linear16ToMillibels(pReverb->m_nLateGain << 2); 796135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 797135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_REVERB_LEVEL %d", *pValue16); 798135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 799135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_REVERB_LEVEL) { 800135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 801135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 802135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue32 = &pProperties->reverbDelay; 803135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 804135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 805135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REVERB_DELAY: 806135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // convert samples to ms 807135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValue32 = (pReverb->m_nLateDelay * 1000) / pReverb->m_nSamplingRate; 808135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 809135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_REVERB_DELAY, samples %d, ms %d", pReverb->m_nLateDelay, *pValue32); 810135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 811135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_REVERB_DELAY) { 812135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 813135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 814135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue16 = &pProperties->diffusion; 815135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 816135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 817135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DIFFUSION: 818135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (int16_t) ((1000 * (pReverb->m_sAp0.m_nApGain - AP0_GAIN_BASE)) 819135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent / AP0_GAIN_RANGE); 820135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 821135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp < 0) 822135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = 0; 823135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > 1000) 824135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = 1000; 825135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 826135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValue16 = temp; 827135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_DIFFUSION, %d, AP0 gain %d", *pValue16, pReverb->m_sAp0.m_nApGain); 828135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 829135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_DIFFUSION) { 830135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 831135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 832135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pValue16 = &pProperties->density; 833135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 834135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 835135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DENSITY: 836135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Calculate AP delay in time units 837135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = ((pReverb->m_sAp0.m_zApOut - pReverb->m_sAp0.m_zApIn) << 16) 838135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent / pReverb->m_nSamplingRate; 839135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 840135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (int16_t) ((1000 * (temp - AP0_TIME_BASE)) / AP0_TIME_RANGE); 841135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 842135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp < 0) 843135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = 0; 844135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > 1000) 845135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = 1000; 846135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 847135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pValue16 = temp; 848135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 849135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("get REVERB_PARAM_DENSITY, %d, AP0 delay smps %d", *pValue16, pReverb->m_sAp0.m_zApOut - pReverb->m_sAp0.m_zApIn); 850135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 851135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 852135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 853135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 854135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 855135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 856135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_getParameter, context %p, param %d, value %d", 857135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb, param, *(int *)pValue); 858135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 859135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 860135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end Reverb_getParameter */ 861135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 862135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 863135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb_setParameter() 864135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 865135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 866135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Set a Reverb parameter 867135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 868135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 869135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb - handle to instance data 870135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * param - parameter 871135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pValue - pointer to parameter value 872135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * size - value size 873135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 874135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 875135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 876135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 877135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 878135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 879135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 880135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 881135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentint Reverb_setParameter(reverb_object_t *pReverb, int32_t param, size_t size, 882135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent void *pValue) { 883135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t value32; 884135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t value16; 885135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent t_reverb_properties *pProperties; 886135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t i; 887135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t temp; 888135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t temp2; 889135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_preset_t *pPreset; 890135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int maxSamples; 891135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t averageDelay; 892135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent size_t paramSize; 893135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 894135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Reverb_setParameter, context %p, param %d, value16 %d, value32 %d", 895135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb, param, *(int16_t *)pValue, *(int32_t *)pValue); 896135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 897135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_Preset && param != REVERB_PARAM_PRESET) { 898135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 899135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 900135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (!pReverb->m_Preset && param == REVERB_PARAM_PRESET) { 901135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 902135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 903135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 904135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (param) { 905135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_ROOM_LEVEL: 906135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_ROOM_HF_LEVEL: 907135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DECAY_HF_RATIO: 908135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REFLECTIONS_LEVEL: 909135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REVERB_LEVEL: 910135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DIFFUSION: 911135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DENSITY: 912135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent paramSize = sizeof(int16_t); 913135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 914135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 915135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_BYPASS: 916135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_PRESET: 917135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DECAY_TIME: 918135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REFLECTIONS_DELAY: 919135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REVERB_DELAY: 920135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent paramSize = sizeof(int32_t); 921135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 922135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 923135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_PROPERTIES: 924135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent paramSize = sizeof(t_reverb_properties); 925135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 926135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 927135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 928135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 929135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 930135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 931135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (size != paramSize) { 932135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 933135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 934135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 935135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (paramSize == sizeof(int16_t)) { 936135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value16 = *(int16_t *) pValue; 937135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else if (paramSize == sizeof(int32_t)) { 938135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value32 = *(int32_t *) pValue; 939135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 940135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pProperties = (t_reverb_properties *) pValue; 941135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 942135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 943135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset = &pReverb->m_sPreset.m_sPreset[pReverb->m_nCurrentRoom]; 944135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 945135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent switch (param) { 946135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_BYPASS: 947135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_bBypass = (uint16_t)value32; 948135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 949135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_PRESET: 950135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (value32 != REVERB_PRESET_LARGE_HALL && value32 951135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent != REVERB_PRESET_HALL && value32 != REVERB_PRESET_CHAMBER 952135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent && value32 != REVERB_PRESET_ROOM) 953135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 954135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nNextRoom = (int16_t) value32; 955135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 956135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 957135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_PROPERTIES: 958135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value16 = pProperties->roomLevel; 959135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 960135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 961135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_ROOM_LEVEL: 962135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert millibels to linear 16 bit signed => m_nRoomLpfFwd 963135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (value16 > 0) 964135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 965135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 966135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = Effects_MillibelsToLinear16(value16); 967135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 968135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRoomLpfFwd 969135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = MULT_EG1_EG1(temp, (32767 - pReverb->m_nRoomLpfFbk)); 970135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 971135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_ROOM_LEVEL, gain %d, new m_nRoomLpfFwd %d, m_nRoomLpfFbk %d", temp, pReverb->m_nRoomLpfFwd, pReverb->m_nRoomLpfFbk); 972135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_ROOM_LEVEL) 973135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 974135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value16 = pProperties->roomHFLevel; 975135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 976135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 977135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_ROOM_HF_LEVEL: 978135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 979135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Limit to 0 , -40dB range because of low pass implementation 980135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (value16 > 0 || value16 < -4000) 981135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 982135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert attenuation @ 5000H expressed in millibels to => m_nRoomLpfFbk 983135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // m_nRoomLpfFbk is -a1 where a1 is the solution of: 984135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // a1^2 + 2*(C-dG^2)/(1-dG^2)*a1 + 1 = 0 where: 985135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // - C is cos(2*pi*5000/Fs) (pReverb->m_nCosWT_5KHz) 986135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // - dG is G0/Gf (G0 is the linear gain at DC and Gf is the wanted gain at 5000Hz) 987135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 988135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Save current DC gain m_nRoomLpfFwd / (32767 - m_nRoomLpfFbk) to keep it unchanged 989135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // while changing HF level 990135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp2 = (pReverb->m_nRoomLpfFwd << 15) / (32767 991135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - pReverb->m_nRoomLpfFbk); 992135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (value16 == 0) { 993135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRoomLpfFbk = 0; 994135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 995135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t dG2, b, delta; 996135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 997135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // dG^2 998135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = Effects_MillibelsToLinear16(value16); 999135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, HF gain %d", temp); 1000135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (1 << 30) / temp; 1001135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, 1/ HF gain %d", temp); 1002135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent dG2 = (int32_t) (((int64_t) temp * (int64_t) temp) >> 15); 1003135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, 1/ HF gain ^ 2 %d", dG2); 1004135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // b = 2*(C-dG^2)/(1-dG^2) 1005135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent b = (int32_t) ((((int64_t) 1 << (15 + 1)) 1006135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ((int64_t) pReverb->m_nCosWT_5KHz - (int64_t) dG2)) 1007135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent / ((int64_t) 32767 - (int64_t) dG2)); 1008135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1009135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // delta = b^2 - 4 1010135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent delta = (int32_t) ((((int64_t) b * (int64_t) b) >> 15) - (1 << (15 1011135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent + 2))); 1012135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1013135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV_IF(delta > (1<<30), " delta overflow %d", delta); 1014135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1015135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, dG2 %d, b %d, delta %d, m_nCosWT_5KHz %d", dG2, b, delta, pReverb->m_nCosWT_5KHz); 1016135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // m_nRoomLpfFbk = -a1 = - (- b + sqrt(delta)) / 2 1017135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRoomLpfFbk = (b - Effects_Sqrt(delta) * 181) >> 1; 1018135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1019135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, olg DC gain %d new m_nRoomLpfFbk %d, old m_nRoomLpfFwd %d", 1020135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp2, pReverb->m_nRoomLpfFbk, pReverb->m_nRoomLpfFwd); 1021135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1022135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRoomLpfFwd 1023135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = MULT_EG1_EG1(temp2, (32767 - pReverb->m_nRoomLpfFbk)); 1024135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_ROOM_HF_LEVEL, new m_nRoomLpfFwd %d", pReverb->m_nRoomLpfFwd); 1025135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1026135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_ROOM_HF_LEVEL) 1027135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1028135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value32 = pProperties->decayTime; 1029135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 1030135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1031135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DECAY_TIME: 1032135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1033135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert milliseconds to => m_nRvbLpfFwd (function of m_nRvbLpfFbk) 1034135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // convert ms to samples 1035135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value32 = (value32 * pReverb->m_nSamplingRate) / 1000; 1036135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate valid decay time range as a function of current reverb delay and 1037135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // max feed back gain. Min value <=> -40dB in one pass, Max value <=> feedback gain = -1 dB 1038135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Calculate attenuation for each round in late reverb given a total attenuation of -6000 millibels. 1039135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // g = -6000 d/DT , g gain in millibels, d reverb delay, DT decay time 1040135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent averageDelay = pReverb->m_nLateDelay - pReverb->m_nMaxExcursion; 1041135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent averageDelay += ((pReverb->m_sAp0.m_zApOut - pReverb->m_sAp0.m_zApIn) 1042135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent + (pReverb->m_sAp1.m_zApOut - pReverb->m_sAp1.m_zApIn)) >> 1; 1043135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1044135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (-6000 * averageDelay) / value32; 1045135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_DECAY_TIME, delay smps %d, DT smps %d, gain mB %d",averageDelay, value32, temp); 1046135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp < -4000 || temp > -100) 1047135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 1048135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1049135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate low pass gain by adding reverb input attenuation (pReverb->m_nLateGain) and substrating output 1050135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // xfade and sum gain (max +9dB) 1051135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp -= Effects_Linear16ToMillibels(pReverb->m_nLateGain) + 900; 1052135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = Effects_MillibelsToLinear16(temp); 1053135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1054135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // DC gain (temp) = b0 / (1 + a1) = pReverb->m_nRvbLpfFwd / (32767 - pReverb->m_nRvbLpfFbk) 1055135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRvbLpfFwd 1056135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = MULT_EG1_EG1(temp, (32767 - pReverb->m_nRvbLpfFbk)); 1057135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1058135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric 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)); 1059135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1060135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_DECAY_TIME) 1061135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1062135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value16 = pProperties->decayHFRatio; 1063135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 1064135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1065135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DECAY_HF_RATIO: 1066135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1067135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // We limit max value to 1000 because reverb filter is lowpass only 1068135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (value16 < 100 || value16 > 1000) 1069135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 1070135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert per mille to => m_nLpfFwd, m_nLpfFbk 1071135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1072135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Save current DC gain m_nRoomLpfFwd / (32767 - m_nRoomLpfFbk) to keep it unchanged 1073135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // while changing HF level 1074135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp2 = (pReverb->m_nRvbLpfFwd << 15) / (32767 - pReverb->m_nRvbLpfFbk); 1075135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1076135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (value16 == 1000) { 1077135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRvbLpfFbk = 0; 1078135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 1079135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t dG2, b, delta; 1080135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1081135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = Effects_Linear16ToMillibels(temp2); 1082135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // G_5000Hz = G_DC * (1000/REVERB_PARAM_DECAY_HF_RATIO) in millibels 1083135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1084135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value32 = ((int32_t) 1000 << 15) / (int32_t) value16; 1085135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_DECAY_HF_RATIO, DC gain %d, DC gain mB %d, 1000/R %d", temp2, temp, value32); 1086135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1087135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (int32_t) (((int64_t) temp * (int64_t) value32) >> 15); 1088135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1089135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp < -4000) { 1090135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_DECAY_HF_RATIO HF gain overflow %d mB", temp); 1091135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = -4000; 1092135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1093135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1094135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = Effects_MillibelsToLinear16(temp); 1095135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_DECAY_HF_RATIO, HF gain %d", temp); 1096135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // dG^2 1097135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (temp2 << 15) / temp; 1098135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent dG2 = (int32_t) (((int64_t) temp * (int64_t) temp) >> 15); 1099135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1100135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // b = 2*(C-dG^2)/(1-dG^2) 1101135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent b = (int32_t) ((((int64_t) 1 << (15 + 1)) 1102135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ((int64_t) pReverb->m_nCosWT_5KHz - (int64_t) dG2)) 1103135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent / ((int64_t) 32767 - (int64_t) dG2)); 1104135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1105135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // delta = b^2 - 4 1106135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent delta = (int32_t) ((((int64_t) b * (int64_t) b) >> 15) - (1 << (15 1107135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent + 2))); 1108135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1109135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // m_nRoomLpfFbk = -a1 = - (- b + sqrt(delta)) / 2 1110135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRvbLpfFbk = (b - Effects_Sqrt(delta) * 181) >> 1; 1111135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1112135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_DECAY_HF_RATIO, dG2 %d, b %d, delta %d", dG2, b, delta); 1113135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1114135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1115135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1116135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_DECAY_HF_RATIO, gain %d, m_nRvbLpfFbk %d, m_nRvbLpfFwd %d", temp2, pReverb->m_nRvbLpfFbk, pReverb->m_nRvbLpfFwd); 1117135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1118135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRvbLpfFwd 1119135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = MULT_EG1_EG1(temp2, (32767 - pReverb->m_nRvbLpfFbk)); 1120135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1121135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_DECAY_HF_RATIO) 1122135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1123135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value16 = pProperties->reflectionsLevel; 1124135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 1125135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1126135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REFLECTIONS_LEVEL: 1127135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // We limit max value to 0 because gain is limited to 0dB 1128135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (value16 > 0 || value16 < -6000) 1129135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 1130135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1131135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert millibels to linear 16 bit signed and recompute m_sEarlyL.m_nGain[i] and m_sEarlyR.m_nGain[i]. 1132135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value16 = Effects_MillibelsToLinear16(value16); 1133135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; i < REVERB_MAX_NUM_REFLECTIONS; i++) { 1134135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyL.m_nGain[i] 1135135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = MULT_EG1_EG1(pPreset->m_sEarlyL.m_nGain[i],value16); 1136135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyR.m_nGain[i] 1137135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = MULT_EG1_EG1(pPreset->m_sEarlyR.m_nGain[i],value16); 1138135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1139135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nEarlyGain = value16; 1140135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_REFLECTIONS_LEVEL, m_nEarlyGain %d", pReverb->m_nEarlyGain); 1141135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1142135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_REFLECTIONS_LEVEL) 1143135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1144135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value32 = pProperties->reflectionsDelay; 1145135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 1146135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1147135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REFLECTIONS_DELAY: 1148135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // We limit max value MAX_EARLY_TIME 1149135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // convert ms to time units 1150135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (value32 * 65536) / 1000; 1151135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp < 0 || temp > MAX_EARLY_TIME) 1152135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 1153135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1154135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxSamples = (int32_t) (MAX_EARLY_TIME * pReverb->m_nSamplingRate) 1155135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16; 1156135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1157135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; i < REVERB_MAX_NUM_REFLECTIONS; i++) { 1158135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp2 = temp + (((int32_t) pPreset->m_sEarlyL.m_zDelay[i] 1159135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb->m_nSamplingRate) >> 16); 1160135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp2 > maxSamples) 1161135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp2 = maxSamples; 1162135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyL.m_zDelay[i] = pReverb->m_nEarly0in + temp2; 1163135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp2 = temp + (((int32_t) pPreset->m_sEarlyR.m_zDelay[i] 1164135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb->m_nSamplingRate) >> 16); 1165135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp2 > maxSamples) 1166135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp2 = maxSamples; 1167135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyR.m_zDelay[i] = pReverb->m_nEarly1in + temp2; 1168135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1169135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nEarlyDelay = temp; 1170135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1171135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_REFLECTIONS_DELAY, m_nEarlyDelay smps %d max smp delay %d", pReverb->m_nEarlyDelay, maxSamples); 1172135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1173135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert milliseconds to sample count => m_nEarlyDelay 1174135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_REFLECTIONS_DELAY) 1175135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1176135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value16 = pProperties->reverbLevel; 1177135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 1178135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1179135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REVERB_LEVEL: 1180135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // We limit max value to 0 because gain is limited to 0dB 1181135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (value16 > 0 || value16 < -6000) 1182135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 1183135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert millibels to linear 16 bits (gange 0 - 8191) => m_nLateGain. 1184135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nLateGain = Effects_MillibelsToLinear16(value16) >> 2; 1185135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1186135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_REVERB_LEVEL, m_nLateGain %d", pReverb->m_nLateGain); 1187135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1188135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_REVERB_LEVEL) 1189135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1190135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value32 = pProperties->reverbDelay; 1191135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 1192135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1193135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_REVERB_DELAY: 1194135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // We limit max value to MAX_DELAY_TIME 1195135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // convert ms to time units 1196135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (value32 * 65536) / 1000; 1197135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp < 0 || temp > MAX_DELAY_TIME) 1198135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 1199135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1200135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxSamples = (int32_t) (MAX_DELAY_TIME * pReverb->m_nSamplingRate) 1201135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16; 1202135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1203135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if ((temp + pReverb->m_nMaxExcursion) > maxSamples) { 1204135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples - pReverb->m_nMaxExcursion; 1205135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1206135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp < pReverb->m_nMaxExcursion) { 1207135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = pReverb->m_nMaxExcursion; 1208135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1209135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1210135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp -= pReverb->m_nLateDelay; 1211135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelay0Out += temp; 1212135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelay1Out += temp; 1213135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nLateDelay += temp; 1214135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1215135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_REVERB_DELAY, m_nLateDelay smps %d max smp delay %d", pReverb->m_nLateDelay, maxSamples); 1216135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1217135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert milliseconds to sample count => m_nDelay1Out + m_nMaxExcursion 1218135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_REVERB_DELAY) 1219135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1220135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1221135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value16 = pProperties->diffusion; 1222135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 1223135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1224135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DIFFUSION: 1225135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (value16 < 0 || value16 > 1000) 1226135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 1227135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1228135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert per mille to m_sAp0.m_nApGain, m_sAp1.m_nApGain 1229135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp0.m_nApGain = AP0_GAIN_BASE + ((int32_t) value16 1230135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * AP0_GAIN_RANGE) / 1000; 1231135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp1.m_nApGain = AP1_GAIN_BASE + ((int32_t) value16 1232135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * AP1_GAIN_RANGE) / 1000; 1233135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1234135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric 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); 1235135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1236135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (param == REVERB_PARAM_DIFFUSION) 1237135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1238135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1239135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent value16 = pProperties->density; 1240135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* FALL THROUGH */ 1241135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1242135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent case REVERB_PARAM_DENSITY: 1243135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (value16 < 0 || value16 > 1000) 1244135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return -EINVAL; 1245135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1246135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Convert per mille to m_sAp0.m_zApOut, m_sAp1.m_zApOut 1247135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxSamples = (int32_t) (MAX_AP_TIME * pReverb->m_nSamplingRate) >> 16; 1248135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1249135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = AP0_TIME_BASE + ((int32_t) value16 * AP0_TIME_RANGE) / 1000; 1250135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1251135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1252135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > maxSamples) 1253135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples; 1254135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp0.m_zApOut = (uint16_t) (pReverb->m_sAp0.m_zApIn + temp); 1255135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1256135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("REVERB_PARAM_DENSITY, Ap0 delay smps %d", temp); 1257135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1258135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = AP1_TIME_BASE + ((int32_t) value16 * AP1_TIME_RANGE) / 1000; 1259135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1260135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1261135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > maxSamples) 1262135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples; 1263135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp1.m_zApOut = (uint16_t) (pReverb->m_sAp1.m_zApIn + temp); 1264135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1265135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent LOGV("Ap1 delay smps %d", temp); 1266135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1267135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1268135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1269135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent default: 1270135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent break; 1271135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1272135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 1273135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end Reverb_setParameter */ 1274135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1275135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1276135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ReverbUpdateXfade 1277135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1278135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 1279135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Update the xfade parameters as required 1280135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1281135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1282135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * nNumSamplesToAdd - number of samples to write to buffer 1283135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1284135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1285135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1286135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1287135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 1288135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * - xfade parameters will be changed 1289135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1290135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1291135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1292135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int ReverbUpdateXfade(reverb_object_t *pReverb, int nNumSamplesToAdd) { 1293135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint16_t nOffset; 1294135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t tempCos; 1295135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t tempSin; 1296135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1297135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_nXfadeCounter >= pReverb->m_nXfadeInterval) { 1298135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* update interval has elapsed, so reset counter */ 1299135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nXfadeCounter = 0; 1300135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1301135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Pin the sin,cos values to min / max values to ensure that the 1302135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // modulated taps' coefs are zero (thus no clicks) 1303135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_nPhaseIncrement > 0) { 1304135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // if phase increment > 0, then sin -> 1, cos -> 0 1305135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSin = 32767; 1306135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCos = 0; 1307135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1308135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // reset the phase to match the sin, cos values 1309135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhase = 32767; 1310135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1311135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // modulate the cross taps because their tap coefs are zero 1312135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 1313135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1314135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD1Cross = pReverb->m_nDelay1Out 1315135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - pReverb->m_nMaxExcursion + nOffset; 1316135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1317135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 1318135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1319135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD0Cross = pReverb->m_nDelay0Out 1320135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - pReverb->m_nMaxExcursion - nOffset; 1321135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 1322135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // if phase increment < 0, then sin -> 0, cos -> 1 1323135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSin = 0; 1324135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCos = 32767; 1325135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1326135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // reset the phase to match the sin, cos values 1327135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhase = -32768; 1328135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1329135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // modulate the self taps because their tap coefs are zero 1330135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 1331135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1332135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD0Self = pReverb->m_nDelay0Out 1333135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - pReverb->m_nMaxExcursion - nOffset; 1334135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1335135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nOffset = ReverbCalculateNoise(pReverb); 1336135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1337135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zD1Self = pReverb->m_nDelay1Out 1338135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent - pReverb->m_nMaxExcursion + nOffset; 1339135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1340135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } // end if-else (pReverb->m_nPhaseIncrement > 0) 1341135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1342135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // Reverse the direction of the sin,cos so that the 1343135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // tap whose coef was previously increasing now decreases 1344135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // and vice versa 1345135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhaseIncrement = -pReverb->m_nPhaseIncrement; 1346135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1347135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } // end if counter >= update interval 1348135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1349135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //compute what phase will be next time 1350135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nPhase += pReverb->m_nPhaseIncrement; 1351135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1352135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //calculate what the new sin and cos need to reach by the next update 1353135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent ReverbCalculateSinCos(pReverb->m_nPhase, &tempSin, &tempCos); 1354135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1355135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //calculate the per-sample increment required to get there by the next update 1356135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1357135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSinIncrement = (tempSin - pReverb->m_nSin) 1358135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> pReverb->m_nUpdatePeriodInBits; 1359135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1360135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1361135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCosIncrement = (tempCos - pReverb->m_nCos) 1362135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> pReverb->m_nUpdatePeriodInBits; 1363135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1364135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* increment update counter */ 1365135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nXfadeCounter += (uint16_t) nNumSamplesToAdd; 1366135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1367135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 1368135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1369135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end ReverbUpdateXfade */ 1370135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1371135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1372135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ReverbCalculateNoise 1373135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1374135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 1375135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Calculate a noise sample and limit its value 1376135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1377135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1378135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * nMaxExcursion - noise value is limited to this value 1379135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pnNoise - return new noise sample in this (not limited) 1380135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1381135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1382135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * new limited noise value 1383135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1384135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 1385135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * - *pnNoise noise value is updated 1386135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1387135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1388135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1389135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic uint16_t ReverbCalculateNoise(reverb_object_t *pReverb) { 1390135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int16_t nNoise = pReverb->m_nNoise; 1391135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1392135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate new noise value 1393135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (pReverb->m_bUseNoise) { 1394135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nNoise = (int16_t) (nNoise * 5 + 1); 1395135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else { 1396135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nNoise = 0; 1397135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1398135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1399135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nNoise = nNoise; 1400135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // return the limited noise value 1401135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return (pReverb->m_nMaxExcursion & nNoise); 1402135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1403135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end ReverbCalculateNoise */ 1404135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1405135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1406135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ReverbCalculateSinCos 1407135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1408135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 1409135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Calculate a new sin and cosine value based on the given phase 1410135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1411135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1412135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * nPhase - phase angle 1413135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pnSin - input old value, output new value 1414135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pnCos - input old value, output new value 1415135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1416135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1417135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1418135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 1419135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * - *pnSin, *pnCos are updated 1420135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1421135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1422135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1423135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int ReverbCalculateSinCos(int16_t nPhase, int16_t *pnSin, int16_t *pnCos) { 1424135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nTemp; 1425135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nNetAngle; 1426135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1427135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // -1 <= nPhase < 1 1428135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // However, for the calculation, we need a value 1429135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // that ranges from -1/2 to +1/2, so divide the phase by 2 1430135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1431135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nNetAngle = nPhase >> 1; 1432135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1433135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* 1434135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent Implement the following 1435135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent sin(x) = (2-4*c)*x^2 + c + x 1436135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent cos(x) = (2-4*c)*x^2 + c - x 1437135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1438135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent where c = 1/sqrt(2) 1439135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent using the a0 + x*(a1 + x*a2) approach 1440135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1441135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1442135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* limit the input "angle" to be between -0.5 and +0.5 */ 1443135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (nNetAngle > EG1_HALF) { 1444135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nNetAngle = EG1_HALF; 1445135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else if (nNetAngle < EG1_MINUS_HALF) { 1446135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nNetAngle = EG1_MINUS_HALF; 1447135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1448135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1449135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* calculate sin */ 1450135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp = EG1_ONE + MULT_EG1_EG1(REVERB_PAN_G2, nNetAngle); 1451135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp = REVERB_PAN_G0 + MULT_EG1_EG1(nTemp, nNetAngle); 1452135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pnSin = (int16_t) SATURATE_EG1(nTemp); 1453135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1454135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /* calculate cos */ 1455135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp = -EG1_ONE + MULT_EG1_EG1(REVERB_PAN_G2, nNetAngle); 1456135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp = REVERB_PAN_G0 + MULT_EG1_EG1(nTemp, nNetAngle); 1457135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pnCos = (int16_t) SATURATE_EG1(nTemp); 1458135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1459135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 1460135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end ReverbCalculateSinCos */ 1461135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1462135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1463135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Reverb 1464135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1465135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 1466135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * apply reverb to the given signal 1467135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1468135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1469135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * nNu 1470135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pnSin - input old value, output new value 1471135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pnCos - input old value, output new value 1472135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1473135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1474135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * number of samples actually reverberated 1475135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1476135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 1477135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1478135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1479135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1480135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int Reverb(reverb_object_t *pReverb, int nNumSamplesToAdd, 1481135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent short *pOutputBuffer, short *pInputBuffer) { 1482135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t i; 1483135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nDelayOut0; 1484135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nDelayOut1; 1485135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint16_t nBase; 1486135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1487135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent uint32_t nAddr; 1488135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nTemp1; 1489135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nTemp2; 1490135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nApIn; 1491135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nApOut; 1492135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1493135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t j; 1494135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t nEarlyOut; 1495135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1496135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int32_t tempValue; 1497135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1498135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // get the base address 1499135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nBase = pReverb->m_nBaseIndex; 1500135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1501135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; i < nNumSamplesToAdd; i++) { 1502135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** Left Allpass - start 1503135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = *pInputBuffer; 1504135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (!pReverb->m_Aux) { 1505135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pInputBuffer++; 1506135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1507135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // store to early delay line 1508135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_nEarly0in, pReverb->m_nBufferMask); 1509135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nApIn; 1510135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1511135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // left input = (left dry * m_nLateGain) + right feedback from previous period 1512135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1513135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = SATURATE(nApIn + pReverb->m_nRevFbkR); 1514135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = MULT_EG1_EG1(nApIn, pReverb->m_nLateGain); 1515135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1516135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch allpass delay line out 1517135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //nAddr = CIRCULAR(nBase, psAp0->m_zApOut, pReverb->m_nBufferMask); 1518135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1519135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sAp0.m_zApOut, pReverb->m_nBufferMask); 1520135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = pReverb->m_nDelayLine[nAddr]; 1521135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1522135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate allpass feedforward; subtract the feedforward result 1523135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nApIn, pReverb->m_sAp0.m_nApGain); 1524135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApOut = SATURATE(nDelayOut0 - nTemp1); // allpass output 1525135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1526135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate allpass feedback; add the feedback result 1527135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nApOut, pReverb->m_sAp0.m_nApGain); 1528135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = SATURATE(nApIn + nTemp1); 1529135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1530135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // inject into allpass delay 1531135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1532135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sAp0.m_zApIn, pReverb->m_nBufferMask); 1533135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nTemp1; 1534135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1535135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // inject allpass output into delay line 1536135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD0In, pReverb->m_nBufferMask); 1537135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nApOut; 1538135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1539135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** Left Allpass - end 1540135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1541135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** Right Allpass - start 1542135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = (*pInputBuffer++); 1543135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // store to early delay line 1544135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_nEarly1in, pReverb->m_nBufferMask); 1545135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nApIn; 1546135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1547135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // right input = (right dry * m_nLateGain) + left feedback from previous period 1548135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} use shift for performance */ 1549135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = SATURATE(nApIn + pReverb->m_nRevFbkL); 1550135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApIn = MULT_EG1_EG1(nApIn, pReverb->m_nLateGain); 1551135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1552135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch allpass delay line out 1553135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1554135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sAp1.m_zApOut, pReverb->m_nBufferMask); 1555135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = pReverb->m_nDelayLine[nAddr]; 1556135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1557135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate allpass feedforward; subtract the feedforward result 1558135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nApIn, pReverb->m_sAp1.m_nApGain); 1559135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nApOut = SATURATE(nDelayOut1 - nTemp1); // allpass output 1560135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1561135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate allpass feedback; add the feedback result 1562135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nApOut, pReverb->m_sAp1.m_nApGain); 1563135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = SATURATE(nApIn + nTemp1); 1564135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1565135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // inject into allpass delay 1566135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1567135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sAp1.m_zApIn, pReverb->m_nBufferMask); 1568135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nTemp1; 1569135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1570135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // inject allpass output into delay line 1571135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD1In, pReverb->m_nBufferMask); 1572135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelayLine[nAddr] = (short) nApOut; 1573135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1574135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** Right Allpass - end 1575135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1576135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** D0 output - start 1577135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line self out 1578135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD0Self, pReverb->m_nBufferMask); 1579135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = pReverb->m_nDelayLine[nAddr]; 1580135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1581135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate delay line self out 1582135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut0, pReverb->m_nSin); 1583135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1584135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line cross out 1585135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD1Cross, pReverb->m_nBufferMask); 1586135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = pReverb->m_nDelayLine[nAddr]; 1587135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1588135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate delay line self out 1589135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(nDelayOut0, pReverb->m_nCos); 1590135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1591135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate unfiltered delay out 1592135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = SATURATE(nTemp1 + nTemp2); 1593135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1594135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** D0 output - end 1595135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1596135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** D1 output - start 1597135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line self out 1598135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD1Self, pReverb->m_nBufferMask); 1599135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = pReverb->m_nDelayLine[nAddr]; 1600135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1601135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate delay line self out 1602135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut1, pReverb->m_nSin); 1603135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1604135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line cross out 1605135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr = CIRCULAR(nBase, pReverb->m_zD0Cross, pReverb->m_nBufferMask); 1606135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = pReverb->m_nDelayLine[nAddr]; 1607135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1608135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate delay line self out 1609135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(nDelayOut1, pReverb->m_nCos); 1610135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1611135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate unfiltered delay out 1612135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = SATURATE(nTemp1 + nTemp2); 1613135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1614135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** D1 output - end 1615135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1616135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** mixer and feedback - start 1617135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // sum is fedback to right input (R + L) 1618135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = (short) SATURATE(nDelayOut0 + nDelayOut1); 1619135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1620135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // difference is feedback to left input (R - L) 1621135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{685} lint complains that it can't saturate negative */ 1622135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = (short) SATURATE(nDelayOut1 - nDelayOut0); 1623135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1624135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** mixer and feedback - end 1625135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1626135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate lowpass filter (mixer scale factor included in LPF feedforward) 1627135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut0, pReverb->m_nRvbLpfFwd); 1628135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1629135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(pReverb->m_nRevFbkL, pReverb->m_nRvbLpfFbk); 1630135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1631135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate filtered delay out and simultaneously update LPF state variable 1632135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // filtered delay output is stored in m_nRevFbkL 1633135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRevFbkL = (short) SATURATE(nTemp1 + nTemp2); 1634135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1635135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate lowpass filter (mixer scale factor included in LPF feedforward) 1636135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut1, pReverb->m_nRvbLpfFwd); 1637135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1638135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(pReverb->m_nRevFbkR, pReverb->m_nRvbLpfFbk); 1639135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1640135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate filtered delay out and simultaneously update LPF state variable 1641135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // filtered delay output is stored in m_nRevFbkR 1642135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRevFbkR = (short) SATURATE(nTemp1 + nTemp2); 1643135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1644135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** start early reflection generator, left 1645135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //psEarly = &(pReverb->m_sEarlyL); 1646135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1647135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1648135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (j = 0; j < REVERB_MAX_NUM_REFLECTIONS; j++) { 1649135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line out 1650135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //nAddr = CIRCULAR(nBase, psEarly->m_zDelay[j], pReverb->m_nBufferMask); 1651135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1652135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sEarlyL.m_zDelay[j], pReverb->m_nBufferMask); 1653135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1654135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = pReverb->m_nDelayLine[nAddr]; 1655135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1656135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate reflection 1657135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //nTemp1 = MULT_EG1_EG1(nDelayOut0, psEarly->m_nGain[j]); 1658135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nTemp1, pReverb->m_sEarlyL.m_nGain[j]); 1659135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1660135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut0 = SATURATE(nDelayOut0 + nTemp1); 1661135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1662135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } // end for (j=0; j < REVERB_MAX_NUM_REFLECTIONS; j++) 1663135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1664135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // apply lowpass to early reflections and reverb output 1665135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //nTemp1 = MULT_EG1_EG1(nEarlyOut, psEarly->m_nRvbLpfFwd); 1666135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut0, pReverb->m_nRoomLpfFwd); 1667135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1668135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //nTemp2 = MULT_EG1_EG1(psEarly->m_zLpf, psEarly->m_nLpfFbk); 1669135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(pReverb->m_zOutLpfL, pReverb->m_nRoomLpfFbk); 1670135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1671135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate filtered out and simultaneously update LPF state variable 1672135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // filtered output is stored in m_zOutLpfL 1673135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zOutLpfL = (short) SATURATE(nTemp1 + nTemp2); 1674135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1675135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //sum with output buffer 1676135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent tempValue = *pOutputBuffer; 1677135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pOutputBuffer++ = (short) SATURATE(tempValue+pReverb->m_zOutLpfL); 1678135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1679135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** end early reflection generator, left 1680135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1681135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** start early reflection generator, right 1682135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //psEarly = &(pReverb->m_sEarlyR); 1683135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1684135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (j = 0; j < REVERB_MAX_NUM_REFLECTIONS; j++) { 1685135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // fetch delay line out 1686135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nAddr 1687135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = CIRCULAR(nBase, pReverb->m_sEarlyR.m_zDelay[j], pReverb->m_nBufferMask); 1688135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = pReverb->m_nDelayLine[nAddr]; 1689135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1690135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate reflection 1691135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nTemp1, pReverb->m_sEarlyR.m_nGain[j]); 1692135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1693135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nDelayOut1 = SATURATE(nDelayOut1 + nTemp1); 1694135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1695135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } // end for (j=0; j < REVERB_MAX_NUM_REFLECTIONS; j++) 1696135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1697135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // apply lowpass to early reflections 1698135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp1 = MULT_EG1_EG1(nDelayOut1, pReverb->m_nRoomLpfFwd); 1699135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1700135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nTemp2 = MULT_EG1_EG1(pReverb->m_zOutLpfR, pReverb->m_nRoomLpfFbk); 1701135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1702135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // calculate filtered out and simultaneously update LPF state variable 1703135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // filtered output is stored in m_zOutLpfR 1704135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_zOutLpfR = (short) SATURATE(nTemp1 + nTemp2); 1705135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1706135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //sum with output buffer 1707135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent tempValue = *pOutputBuffer; 1708135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *pOutputBuffer++ = (short) SATURATE(tempValue + pReverb->m_zOutLpfR); 1709135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1710135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // ********** end early reflection generator, right 1711135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1712135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // decrement base addr for next sample period 1713135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent nBase--; 1714135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1715135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nSin += pReverb->m_nSinIncrement; 1716135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCos += pReverb->m_nCosIncrement; 1717135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1718135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } // end for (i=0; i < nNumSamplesToAdd; i++) 1719135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1720135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // store the most up to date version 1721135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nBaseIndex = nBase; 1722135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1723135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 1724135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end Reverb */ 1725135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1726135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1727135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ReverbUpdateRoom 1728135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1729135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: 1730135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Update the room's preset parameters as required 1731135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1732135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1733135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1734135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1735135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1736135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1737135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Side Effects: 1738135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * - reverb paramters (fbk, fwd, etc) will be changed 1739135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * - m_nCurrentRoom := m_nNextRoom 1740135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1741135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1742135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int ReverbUpdateRoom(reverb_object_t *pReverb, bool fullUpdate) { 1743135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int temp; 1744135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int i; 1745135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int maxSamples; 1746135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int earlyDelay; 1747135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int earlyGain; 1748135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1749135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_preset_t *pPreset = 1750135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent &pReverb->m_sPreset.m_sPreset[pReverb->m_nNextRoom]; 1751135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1752135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (fullUpdate) { 1753135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRvbLpfFwd = pPreset->m_nRvbLpfFwd; 1754135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRvbLpfFbk = pPreset->m_nRvbLpfFbk; 1755135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1756135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nEarlyGain = pPreset->m_nEarlyGain; 1757135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to sample based 1758135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nLateGain = pPreset->m_nLateGain; 1759135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRoomLpfFbk = pPreset->m_nRoomLpfFbk; 1760135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nRoomLpfFwd = pPreset->m_nRoomLpfFwd; 1761135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1762135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // set the early reflections gains 1763135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent earlyGain = pPreset->m_nEarlyGain; 1764135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; i < REVERB_MAX_NUM_REFLECTIONS; i++) { 1765135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyL.m_nGain[i] 1766135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = MULT_EG1_EG1(pPreset->m_sEarlyL.m_nGain[i],earlyGain); 1767135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyR.m_nGain[i] 1768135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent = MULT_EG1_EG1(pPreset->m_sEarlyR.m_nGain[i],earlyGain); 1769135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1770135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1771135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nMaxExcursion = pPreset->m_nMaxExcursion; 1772135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1773135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp0.m_nApGain = pPreset->m_nAp0_ApGain; 1774135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp1.m_nApGain = pPreset->m_nAp1_ApGain; 1775135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1776135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent // set the early reflections delay 1777135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent earlyDelay = ((int) pPreset->m_nEarlyDelay * pReverb->m_nSamplingRate) 1778135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16; 1779135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nEarlyDelay = earlyDelay; 1780135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxSamples = (int32_t) (MAX_EARLY_TIME * pReverb->m_nSamplingRate) 1781135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16; 1782135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (i = 0; i < REVERB_MAX_NUM_REFLECTIONS; i++) { 1783135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to sample based 1784135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = earlyDelay + (((int) pPreset->m_sEarlyL.m_zDelay[i] 1785135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb->m_nSamplingRate) >> 16); 1786135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > maxSamples) 1787135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples; 1788135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyL.m_zDelay[i] = pReverb->m_nEarly0in + temp; 1789135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to sample based 1790135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = earlyDelay + (((int) pPreset->m_sEarlyR.m_zDelay[i] 1791135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * pReverb->m_nSamplingRate) >> 16); 1792135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > maxSamples) 1793135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples; 1794135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sEarlyR.m_zDelay[i] = pReverb->m_nEarly1in + temp; 1795135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1796135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1797135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxSamples = (int32_t) (MAX_DELAY_TIME * pReverb->m_nSamplingRate) 1798135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent >> 16; 1799135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to sample based 1800135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1801135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (pPreset->m_nLateDelay * pReverb->m_nSamplingRate) >> 16; 1802135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if ((temp + pReverb->m_nMaxExcursion) > maxSamples) { 1803135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples - pReverb->m_nMaxExcursion; 1804135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1805135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp -= pReverb->m_nLateDelay; 1806135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelay0Out += temp; 1807135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nDelay1Out += temp; 1808135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nLateDelay += temp; 1809135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1810135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent maxSamples = (int32_t) (MAX_AP_TIME * pReverb->m_nSamplingRate) >> 16; 1811135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to absolute sample value 1812135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = pPreset->m_nAp0_ApOut; 1813135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1814135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1815135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > maxSamples) 1816135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples; 1817135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp0.m_zApOut = (uint16_t) (pReverb->m_sAp0.m_zApIn + temp); 1818135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1819135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to absolute sample value 1820135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = pPreset->m_nAp1_ApOut; 1821135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1822135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1823135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (temp > maxSamples) 1824135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = maxSamples; 1825135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_sAp1.m_zApOut = (uint16_t) (pReverb->m_sAp1.m_zApIn + temp); 1826135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //gpsReverbObject->m_sAp1.m_zApOut = pPreset->m_nAp1_ApOut; 1827135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 1828135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1829135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //stored as time based, convert to sample based 1830135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = pPreset->m_nXfadeInterval; 1831135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent /*lint -e{702} shift for performance */ 1832135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent temp = (temp * pReverb->m_nSamplingRate) >> 16; 1833135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nXfadeInterval = (uint16_t) temp; 1834135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //gsReverbObject.m_nXfadeInterval = pPreset->m_nXfadeInterval; 1835135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nXfadeCounter = pReverb->m_nXfadeInterval + 1; // force update on first iteration 1836135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1837135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1838135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pReverb->m_nCurrentRoom = pReverb->m_nNextRoom; 1839135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1840135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 1841135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1842135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} /* end ReverbUpdateRoom */ 1843135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1844135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent/*---------------------------------------------------------------------------- 1845135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * ReverbReadInPresets() 1846135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1847135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Purpose: sets global reverb preset bank to defaults 1848135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1849135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Inputs: 1850135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1851135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * Outputs: 1852135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent * 1853135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent *---------------------------------------------------------------------------- 1854135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent */ 1855135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurentstatic int ReverbReadInPresets(reverb_object_t *pReverb) { 1856135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1857135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int preset = 0; 1858135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent int defaultPreset = 0; 1859135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 1860135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent //now init any remaining presets to defaults 1861135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent for (defaultPreset = preset; defaultPreset < REVERB_MAX_ROOM_TYPE; defaultPreset++) { 1862135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent reverb_preset_t *pPreset = &pReverb->m_sPreset.m_sPreset[defaultPreset]; 1863135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent if (defaultPreset == 0 || defaultPreset > REVERB_MAX_ROOM_TYPE - 1) { 1864135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRvbLpfFbk = 8307; 1865135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRvbLpfFwd = 14768; 1866135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyGain = 27690; 1867135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyDelay = 1311; 1868135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateGain = 8191; 1869135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateDelay = 3932; 1870135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFbk = 3692; 1871135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFwd = 24569; 1872135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[0] = 1376; 1873135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[0] = 22152; 1874135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[1] = 2163; 1875135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[1] = 17537; 1876135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[2] = 0; 1877135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[2] = 14768; 1878135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[3] = 1835; 1879135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[3] = 14307; 1880135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[4] = 0; 1881135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[4] = 13384; 1882135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[0] = 721; 1883135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[0] = 20306; 1884135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[1] = 2621; 1885135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[1] = 17537; 1886135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[2] = 0; 1887135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[2] = 14768; 1888135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[3] = 0; 1889135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[3] = 16153; 1890135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[4] = 0; 1891135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[4] = 13384; 1892135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nMaxExcursion = 127; 1893135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nXfadeInterval = 6388; 1894135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp0_ApGain = 15691; 1895135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp0_ApOut = 711; 1896135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp1_ApGain = 16317; 1897135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp1_ApOut = 1029; 1898135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu4 = 0; 1899135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu5 = 0; 1900135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu6 = 0; 1901135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu7 = 0; 1902135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu8 = 0; 1903135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu9 = 0; 1904135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu10 = 0; 1905135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else if (defaultPreset == 1) { 1906135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRvbLpfFbk = 6461; 1907135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRvbLpfFwd = 14307; 1908135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyGain = 27690; 1909135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyDelay = 1311; 1910135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateGain = 8191; 1911135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateDelay = 3932; 1912135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFbk = 3692; 1913135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFwd = 24569; 1914135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[0] = 1376; 1915135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[0] = 22152; 1916135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[1] = 1462; 1917135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[1] = 17537; 1918135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[2] = 0; 1919135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[2] = 14768; 1920135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[3] = 1835; 1921135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[3] = 14307; 1922135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[4] = 0; 1923135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[4] = 13384; 1924135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[0] = 721; 1925135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[0] = 20306; 1926135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[1] = 2621; 1927135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[1] = 17537; 1928135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[2] = 0; 1929135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[2] = 14768; 1930135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[3] = 0; 1931135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[3] = 16153; 1932135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[4] = 0; 1933135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[4] = 13384; 1934135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nMaxExcursion = 127; 1935135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nXfadeInterval = 6391; 1936135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp0_ApGain = 15230; 1937135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp0_ApOut = 708; 1938135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp1_ApGain = 15547; 1939135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp1_ApOut = 1023; 1940135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu4 = 0; 1941135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu5 = 0; 1942135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu6 = 0; 1943135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu7 = 0; 1944135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu8 = 0; 1945135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu9 = 0; 1946135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu10 = 0; 1947135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else if (defaultPreset == 2) { 1948135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRvbLpfFbk = 5077; 1949135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRvbLpfFwd = 12922; 1950135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyGain = 27690; 1951135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyDelay = 1311; 1952135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateGain = 8191; 1953135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateDelay = 3932; 1954135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFbk = 3692; 1955135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFwd = 21703; 1956135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[0] = 1376; 1957135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[0] = 22152; 1958135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[1] = 1462; 1959135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[1] = 17537; 1960135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[2] = 0; 1961135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[2] = 14768; 1962135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[3] = 1835; 1963135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[3] = 14307; 1964135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[4] = 0; 1965135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[4] = 13384; 1966135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[0] = 721; 1967135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[0] = 20306; 1968135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[1] = 2621; 1969135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[1] = 17537; 1970135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[2] = 0; 1971135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[2] = 14768; 1972135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[3] = 0; 1973135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[3] = 16153; 1974135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[4] = 0; 1975135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[4] = 13384; 1976135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nMaxExcursion = 127; 1977135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nXfadeInterval = 6449; 1978135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp0_ApGain = 15691; 1979135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp0_ApOut = 774; 1980135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp1_ApGain = 16317; 1981135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp1_ApOut = 1155; 1982135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu4 = 0; 1983135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu5 = 0; 1984135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu6 = 0; 1985135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu7 = 0; 1986135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu8 = 0; 1987135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu9 = 0; 1988135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu10 = 0; 1989135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } else if (defaultPreset == 3) { 1990135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRvbLpfFbk = 5077; 1991135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRvbLpfFwd = 11076; 1992135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyGain = 27690; 1993135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nEarlyDelay = 1311; 1994135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateGain = 8191; 1995135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nLateDelay = 3932; 1996135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFbk = 3692; 1997135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nRoomLpfFwd = 20474; 1998135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[0] = 1376; 1999135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[0] = 22152; 2000135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[1] = 1462; 2001135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[1] = 17537; 2002135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[2] = 0; 2003135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[2] = 14768; 2004135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[3] = 1835; 2005135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[3] = 14307; 2006135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_zDelay[4] = 0; 2007135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyL.m_nGain[4] = 13384; 2008135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[0] = 721; 2009135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[0] = 20306; 2010135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[1] = 2621; 2011135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[1] = 17537; 2012135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[2] = 0; 2013135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[2] = 14768; 2014135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[3] = 0; 2015135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[3] = 16153; 2016135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_zDelay[4] = 0; 2017135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_sEarlyR.m_nGain[4] = 13384; 2018135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nMaxExcursion = 127; 2019135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nXfadeInterval = 6470; //6483; 2020135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp0_ApGain = 14768; 2021135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp0_ApOut = 792; 2022135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp1_ApGain = 14777; 2023135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_nAp1_ApOut = 1191; 2024135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu4 = 0; 2025135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu5 = 0; 2026135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu6 = 0; 2027135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu7 = 0; 2028135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu8 = 0; 2029135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu9 = 0; 2030135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent pPreset->m_rfu10 = 0; 2031135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 2032135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent } 2033135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent 2034135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent return 0; 2035135ad07e33d30e5202deb21061a0e3ecf0ffad35Eric Laurent} 2036