• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * Copyright (C) 2010-2010 NXP Software
3  * Copyright (C) 2009 The Android Open Source Project
4  *
5  * Licensed under the Apache License, Version 2.0 (the "License");
6  * you may not use this file except in compliance with the License.
7  * You may obtain a copy of the License at
8  *
9  *      http://www.apache.org/licenses/LICENSE-2.0
10  *
11  * Unless required by applicable law or agreed to in writing, software
12  * distributed under the License is distributed on an "AS IS" BASIS,
13  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14  * See the License for the specific language governing permissions and
15  * limitations under the License.
16  */
17 
18 #define LOG_TAG "Reverb"
19 #define ARRAY_SIZE(array) (sizeof array / sizeof array[0])
20 //#define LOG_NDEBUG 0
21 
22 #include <cutils/log.h>
23 #include <assert.h>
24 #include <stdlib.h>
25 #include <string.h>
26 #include <new>
27 #include <EffectReverb.h>
28 #include <LVREV.h>
29 
30 // effect_interface_t interface implementation for reverb
31 extern "C" const struct effect_interface_s gReverbInterface;
32 
33 #define LVM_ERROR_CHECK(LvmStatus, callingFunc, calledFunc){\
34         if (LvmStatus == LVREV_NULLADDRESS){\
35             LOGV("\tLVREV_ERROR : Parameter error - "\
36                     "null pointer returned by %s in %s\n\n\n\n", callingFunc, calledFunc);\
37         }\
38         if (LvmStatus == LVREV_INVALIDNUMSAMPLES){\
39             LOGV("\tLVREV_ERROR : Parameter error - "\
40                     "bad number of samples returned by %s in %s\n\n\n\n", callingFunc, calledFunc);\
41         }\
42         if (LvmStatus == LVREV_OUTOFRANGE){\
43             LOGV("\tLVREV_ERROR : Parameter error - "\
44                     "out of range returned by %s in %s\n", callingFunc, calledFunc);\
45         }\
46     }
47 
48 // Namespaces
49 namespace android {
50 namespace {
51 
52 /************************************************************************************/
53 /*                                                                                  */
54 /* Preset definitions                                                               */
55 /*                                                                                  */
56 /************************************************************************************/
57 
58 const static t_reverb_settings sReverbPresets[] = {
59         // REVERB_PRESET_NONE: values are unused
60         {0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
61         // REVERB_PRESET_SMALLROOM
62         {-400, -600, 1100, 830, -400, 5, 500, 10, 1000, 1000},
63         // REVERB_PRESET_MEDIUMROOM
64         {-400, -600, 1300, 830, -1000, 20, -200, 20, 1000, 1000},
65         // REVERB_PRESET_LARGEROOM
66         {-400, -600, 1500, 830, -1600, 5, -1000, 40, 1000, 1000},
67         // REVERB_PRESET_MEDIUMHALL
68         {-400, -600, 1800, 700, -1300, 15, -800, 30, 1000, 1000},
69         // REVERB_PRESET_LARGEHALL
70         {-400, -600, 1800, 700, -2000, 30, -1400, 60, 1000, 1000},
71         // REVERB_PRESET_PLATE
72         {-400, -200, 1300, 900, 0, 2, 0, 10, 1000, 750},
73 };
74 
75 
76 // NXP SW auxiliary environmental reverb
77 const effect_descriptor_t gAuxEnvReverbDescriptor = {
78         { 0xc2e5d5f0, 0x94bd, 0x4763, 0x9cac, { 0x4e, 0x23, 0x4d, 0x06, 0x83, 0x9e } },
79         { 0x4a387fc0, 0x8ab3, 0x11df, 0x8bad, { 0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b } },
80         EFFECT_API_VERSION,
81         EFFECT_FLAG_TYPE_AUXILIARY,
82         LVREV_CUP_LOAD_ARM9E,
83         LVREV_MEM_USAGE,
84         "Auxiliary Environmental Reverb",
85         "NXP Software Ltd.",
86 };
87 
88 // NXP SW insert environmental reverb
89 static const effect_descriptor_t gInsertEnvReverbDescriptor = {
90         {0xc2e5d5f0, 0x94bd, 0x4763, 0x9cac, {0x4e, 0x23, 0x4d, 0x06, 0x83, 0x9e}},
91         {0xc7a511a0, 0xa3bb, 0x11df, 0x860e, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}},
92         EFFECT_API_VERSION,
93         EFFECT_FLAG_TYPE_INSERT | EFFECT_FLAG_INSERT_FIRST | EFFECT_FLAG_VOLUME_CTRL,
94         LVREV_CUP_LOAD_ARM9E,
95         LVREV_MEM_USAGE,
96         "Insert Environmental Reverb",
97         "NXP Software Ltd.",
98 };
99 
100 // NXP SW auxiliary preset reverb
101 static const effect_descriptor_t gAuxPresetReverbDescriptor = {
102         {0x47382d60, 0xddd8, 0x11db, 0xbf3a, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}},
103         {0xf29a1400, 0xa3bb, 0x11df, 0x8ddc, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}},
104         EFFECT_API_VERSION,
105         EFFECT_FLAG_TYPE_AUXILIARY,
106         LVREV_CUP_LOAD_ARM9E,
107         LVREV_MEM_USAGE,
108         "Auxiliary Preset Reverb",
109         "NXP Software Ltd.",
110 };
111 
112 // NXP SW insert preset reverb
113 static const effect_descriptor_t gInsertPresetReverbDescriptor = {
114         {0x47382d60, 0xddd8, 0x11db, 0xbf3a, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}},
115         {0x172cdf00, 0xa3bc, 0x11df, 0xa72f, {0x00, 0x02, 0xa5, 0xd5, 0xc5, 0x1b}},
116         EFFECT_API_VERSION,
117         EFFECT_FLAG_TYPE_INSERT | EFFECT_FLAG_INSERT_FIRST | EFFECT_FLAG_VOLUME_CTRL,
118         LVREV_CUP_LOAD_ARM9E,
119         LVREV_MEM_USAGE,
120         "Insert Preset Reverb",
121         "NXP Software Ltd.",
122 };
123 
124 // gDescriptors contains pointers to all defined effect descriptor in this library
125 static const effect_descriptor_t * const gDescriptors[] = {
126         &gAuxEnvReverbDescriptor,
127         &gInsertEnvReverbDescriptor,
128         &gAuxPresetReverbDescriptor,
129         &gInsertPresetReverbDescriptor
130 };
131 
132 struct ReverbContext{
133     const struct effect_interface_s *itfe;
134     effect_config_t                 config;
135     LVREV_Handle_t                  hInstance;
136     int16_t                         SavedRoomLevel;
137     int16_t                         SavedHfLevel;
138     int16_t                         SavedDecayTime;
139     int16_t                         SavedDecayHfRatio;
140     int16_t                         SavedReverbLevel;
141     int16_t                         SavedDiffusion;
142     int16_t                         SavedDensity;
143     bool                            bEnabled;
144     #ifdef LVM_PCM
145     FILE                            *PcmInPtr;
146     FILE                            *PcmOutPtr;
147     #endif
148     LVM_Fs_en                       SampleRate;
149     LVM_INT32                       *InFrames32;
150     LVM_INT32                       *OutFrames32;
151     bool                            auxiliary;
152     bool                            preset;
153     uint16_t                        curPreset;
154     uint16_t                        nextPreset;
155     int                             SamplesToExitCount;
156     LVM_INT16                       leftVolume;
157     LVM_INT16                       rightVolume;
158     LVM_INT16                       prevLeftVolume;
159     LVM_INT16                       prevRightVolume;
160     int                             volumeMode;
161 };
162 
163 enum {
164     REVERB_VOLUME_OFF,
165     REVERB_VOLUME_FLAT,
166     REVERB_VOLUME_RAMP,
167 };
168 
169 #define REVERB_DEFAULT_PRESET REVERB_PRESET_MEDIUMROOM
170 
171 
172 #define REVERB_SEND_LEVEL   (0x0C00) // 0.75 in 4.12 format
173 #define REVERB_UNIT_VOLUME  (0x1000) // 1.0 in 4.12 format
174 
175 //--- local function prototypes
176 int  Reverb_init            (ReverbContext *pContext);
177 void Reverb_free            (ReverbContext *pContext);
178 int  Reverb_configure       (ReverbContext *pContext, effect_config_t *pConfig);
179 int  Reverb_setParameter    (ReverbContext *pContext, void *pParam, void *pValue);
180 int  Reverb_getParameter    (ReverbContext *pContext,
181                              void          *pParam,
182                              size_t        *pValueSize,
183                              void          *pValue);
184 int Reverb_LoadPreset       (ReverbContext   *pContext);
185 
186 /* Effect Library Interface Implementation */
EffectQueryNumberEffects(uint32_t * pNumEffects)187 extern "C" int EffectQueryNumberEffects(uint32_t *pNumEffects){
188     LOGV("\n\tEffectQueryNumberEffects start");
189     *pNumEffects = sizeof(gDescriptors) / sizeof(const effect_descriptor_t *);
190     LOGV("\tEffectQueryNumberEffects creating %d effects", *pNumEffects);
191     LOGV("\tEffectQueryNumberEffects end\n");
192     return 0;
193 }     /* end EffectQueryNumberEffects */
194 
EffectQueryEffect(uint32_t index,effect_descriptor_t * pDescriptor)195 extern "C" int EffectQueryEffect(uint32_t index, effect_descriptor_t *pDescriptor){
196     LOGV("\n\tEffectQueryEffect start");
197     LOGV("\tEffectQueryEffect processing index %d", index);
198     if (pDescriptor == NULL){
199         LOGV("\tLVM_ERROR : EffectQueryEffect was passed NULL pointer");
200         return -EINVAL;
201     }
202     if (index >= sizeof(gDescriptors) / sizeof(const effect_descriptor_t *)) {
203         LOGV("\tLVM_ERROR : EffectQueryEffect index out of range %d", index);
204         return -ENOENT;
205     }
206     memcpy(pDescriptor, gDescriptors[index], sizeof(effect_descriptor_t));
207     LOGV("\tEffectQueryEffect end\n");
208     return 0;
209 }     /* end EffectQueryEffect */
210 
EffectCreate(effect_uuid_t * uuid,int32_t sessionId,int32_t ioId,effect_interface_t * pInterface)211 extern "C" int EffectCreate(effect_uuid_t       *uuid,
212                             int32_t             sessionId,
213                             int32_t             ioId,
214                             effect_interface_t  *pInterface){
215     int ret;
216     int i;
217     int length = sizeof(gDescriptors) / sizeof(const effect_descriptor_t *);
218     const effect_descriptor_t *desc;
219 
220     LOGV("\t\nEffectCreate start");
221 
222     if (pInterface == NULL || uuid == NULL){
223         LOGV("\tLVM_ERROR : EffectCreate() called with NULL pointer");
224         return -EINVAL;
225     }
226 
227     for (i = 0; i < length; i++) {
228         desc = gDescriptors[i];
229         if (memcmp(uuid, &desc->uuid, sizeof(effect_uuid_t))
230                 == 0) {
231             LOGV("\tEffectCreate - UUID matched Reverb type %d, UUID = %x", i, desc->uuid.timeLow);
232             break;
233         }
234     }
235 
236     if (i == length) {
237         return -ENOENT;
238     }
239 
240     ReverbContext *pContext = new ReverbContext;
241 
242     pContext->itfe      = &gReverbInterface;
243     pContext->hInstance = NULL;
244 
245     pContext->auxiliary = false;
246     if ((desc->flags & EFFECT_FLAG_TYPE_MASK) == EFFECT_FLAG_TYPE_AUXILIARY){
247         pContext->auxiliary = true;
248         LOGV("\tEffectCreate - AUX");
249     }else{
250         LOGV("\tEffectCreate - INS");
251     }
252 
253     pContext->preset = false;
254     if (memcmp(&desc->type, SL_IID_PRESETREVERB, sizeof(effect_uuid_t)) == 0) {
255         pContext->preset = true;
256         // force reloading preset at first call to process()
257         pContext->curPreset = REVERB_PRESET_LAST + 1;
258         pContext->nextPreset = REVERB_DEFAULT_PRESET;
259         LOGV("\tEffectCreate - PRESET");
260     }else{
261         LOGV("\tEffectCreate - ENVIRONMENTAL");
262     }
263 
264     LOGV("\tEffectCreate - Calling Reverb_init");
265     ret = Reverb_init(pContext);
266 
267     if (ret < 0){
268         LOGV("\tLVM_ERROR : EffectCreate() init failed");
269         delete pContext;
270         return ret;
271     }
272 
273     *pInterface = (effect_interface_t)pContext;
274 
275     #ifdef LVM_PCM
276     pContext->PcmInPtr = NULL;
277     pContext->PcmOutPtr = NULL;
278 
279     pContext->PcmInPtr  = fopen("/data/tmp/reverb_pcm_in.pcm", "w");
280     pContext->PcmOutPtr = fopen("/data/tmp/reverb_pcm_out.pcm", "w");
281 
282     if((pContext->PcmInPtr  == NULL)||
283        (pContext->PcmOutPtr == NULL)){
284        return -EINVAL;
285     }
286     #endif
287 
288 
289     // Allocate memory for reverb process (*2 is for STEREO)
290     pContext->InFrames32  = (LVM_INT32 *)malloc(LVREV_MAX_FRAME_SIZE * sizeof(LVM_INT32) * 2);
291     pContext->OutFrames32 = (LVM_INT32 *)malloc(LVREV_MAX_FRAME_SIZE * sizeof(LVM_INT32) * 2);
292 
293     LOGV("\tEffectCreate %p, size %d", pContext, sizeof(ReverbContext));
294     LOGV("\tEffectCreate end\n");
295     return 0;
296 } /* end EffectCreate */
297 
EffectRelease(effect_interface_t interface)298 extern "C" int EffectRelease(effect_interface_t interface){
299     ReverbContext * pContext = (ReverbContext *)interface;
300 
301     LOGV("\tEffectRelease %p", interface);
302     if (pContext == NULL){
303         LOGV("\tLVM_ERROR : EffectRelease called with NULL pointer");
304         return -EINVAL;
305     }
306 
307     #ifdef LVM_PCM
308     fclose(pContext->PcmInPtr);
309     fclose(pContext->PcmOutPtr);
310     #endif
311     free(pContext->InFrames32);
312     free(pContext->OutFrames32);
313     Reverb_free(pContext);
314     delete pContext;
315     return 0;
316 } /* end EffectRelease */
317 
318 /* local functions */
319 #define CHECK_ARG(cond) {                     \
320     if (!(cond)) {                            \
321         LOGV("\tLVM_ERROR : Invalid argument: "#cond);      \
322         return -EINVAL;                       \
323     }                                         \
324 }
325 
326 //----------------------------------------------------------------------------
327 // MonoTo2I_32()
328 //----------------------------------------------------------------------------
329 // Purpose:
330 //  Convert MONO to STEREO
331 //
332 //----------------------------------------------------------------------------
333 
MonoTo2I_32(const LVM_INT32 * src,LVM_INT32 * dst,LVM_INT16 n)334 void MonoTo2I_32( const LVM_INT32  *src,
335                         LVM_INT32  *dst,
336                         LVM_INT16 n)
337 {
338    LVM_INT16 ii;
339    src += (n-1);
340    dst += ((n*2)-1);
341 
342    for (ii = n; ii != 0; ii--)
343    {
344        *dst = *src;
345        dst--;
346 
347        *dst = *src;
348        dst--;
349        src--;
350    }
351 
352    return;
353 }
354 
355 //----------------------------------------------------------------------------
356 // From2iToMono_32()
357 //----------------------------------------------------------------------------
358 // Purpose:
359 //  Convert STEREO to MONO
360 //
361 //----------------------------------------------------------------------------
362 
From2iToMono_32(const LVM_INT32 * src,LVM_INT32 * dst,LVM_INT16 n)363 void From2iToMono_32( const LVM_INT32 *src,
364                             LVM_INT32 *dst,
365                             LVM_INT16 n)
366 {
367    LVM_INT16 ii;
368    LVM_INT32 Temp;
369 
370    for (ii = n; ii != 0; ii--)
371    {
372        Temp = (*src>>1);
373        src++;
374 
375        Temp +=(*src>>1);
376        src++;
377 
378        *dst = Temp;
379        dst++;
380    }
381 
382    return;
383 }
384 
clamp16(int32_t sample)385 static inline int16_t clamp16(int32_t sample)
386 {
387     if ((sample>>15) ^ (sample>>31))
388         sample = 0x7FFF ^ (sample>>31);
389     return sample;
390 }
391 
392 //----------------------------------------------------------------------------
393 // process()
394 //----------------------------------------------------------------------------
395 // Purpose:
396 // Apply the Reverb
397 //
398 // Inputs:
399 //  pIn:        pointer to stereo/mono 16 bit input data
400 //  pOut:       pointer to stereo 16 bit output data
401 //  frameCount: Frames to process
402 //  pContext:   effect engine context
403 //  strength    strength to be applied
404 //
405 //  Outputs:
406 //  pOut:       pointer to updated stereo 16 bit output data
407 //
408 //----------------------------------------------------------------------------
409 
process(LVM_INT16 * pIn,LVM_INT16 * pOut,int frameCount,ReverbContext * pContext)410 int process( LVM_INT16     *pIn,
411              LVM_INT16     *pOut,
412              int           frameCount,
413              ReverbContext *pContext){
414 
415     LVM_INT16               samplesPerFrame = 1;
416     LVREV_ReturnStatus_en   LvmStatus = LVREV_SUCCESS;              /* Function call status */
417     LVM_INT16 *OutFrames16;
418 
419 
420     // Check that the input is either mono or stereo
421     if (pContext->config.inputCfg.channels == CHANNEL_STEREO) {
422         samplesPerFrame = 2;
423     } else if (pContext->config.inputCfg.channels != CHANNEL_MONO) {
424         LOGV("\tLVREV_ERROR : process invalid PCM format");
425         return -EINVAL;
426     }
427 
428     OutFrames16 = (LVM_INT16 *)pContext->OutFrames32;
429 
430     // Check for NULL pointers
431     if((pContext->InFrames32 == NULL)||(pContext->OutFrames32 == NULL)){
432         LOGV("\tLVREV_ERROR : process failed to allocate memory for temporary buffers ");
433         return -EINVAL;
434     }
435 
436     #ifdef LVM_PCM
437     fwrite(pIn, frameCount*sizeof(LVM_INT16)*samplesPerFrame, 1, pContext->PcmInPtr);
438     fflush(pContext->PcmInPtr);
439     #endif
440 
441     if (pContext->preset && pContext->nextPreset != pContext->curPreset) {
442         Reverb_LoadPreset(pContext);
443     }
444 
445 
446 
447     // Convert to Input 32 bits
448     if (pContext->auxiliary) {
449         for(int i=0; i<frameCount*samplesPerFrame; i++){
450             pContext->InFrames32[i] = (LVM_INT32)pIn[i]<<8;
451         }
452     } else {
453         // insert reverb input is always stereo
454         for (int i = 0; i < frameCount; i++) {
455             pContext->InFrames32[2*i] = (pIn[2*i] * REVERB_SEND_LEVEL) >> 4; // <<8 + >>12
456             pContext->InFrames32[2*i+1] = (pIn[2*i+1] * REVERB_SEND_LEVEL) >> 4; // <<8 + >>12
457         }
458     }
459 
460     if (pContext->preset && pContext->curPreset == REVERB_PRESET_NONE) {
461         memset(pContext->OutFrames32, 0, frameCount * sizeof(LVM_INT32) * 2); //always stereo here
462     } else {
463         if(pContext->bEnabled == LVM_FALSE && pContext->SamplesToExitCount > 0) {
464             memset(pContext->InFrames32,0,frameCount * sizeof(LVM_INT32) * samplesPerFrame);
465             LOGV("\tZeroing %d samples per frame at the end of call", samplesPerFrame);
466         }
467 
468         /* Process the samples, producing a stereo output */
469         LvmStatus = LVREV_Process(pContext->hInstance,      /* Instance handle */
470                                   pContext->InFrames32,     /* Input buffer */
471                                   pContext->OutFrames32,    /* Output buffer */
472                                   frameCount);              /* Number of samples to read */
473     }
474 
475     LVM_ERROR_CHECK(LvmStatus, "LVREV_Process", "process")
476     if(LvmStatus != LVREV_SUCCESS) return -EINVAL;
477 
478     // Convert to 16 bits
479     if (pContext->auxiliary) {
480         for (int i=0; i < frameCount*2; i++) { //always stereo here
481             OutFrames16[i] = clamp16(pContext->OutFrames32[i]>>8);
482         }
483     } else {
484         for (int i=0; i < frameCount*2; i++) { //always stereo here
485             OutFrames16[i] = clamp16((pContext->OutFrames32[i]>>8) + (LVM_INT32)pIn[i]);
486         }
487 
488         // apply volume with ramp if needed
489         if ((pContext->leftVolume != pContext->prevLeftVolume ||
490                 pContext->rightVolume != pContext->prevRightVolume) &&
491                 pContext->volumeMode == REVERB_VOLUME_RAMP) {
492             LVM_INT32 vl = (LVM_INT32)pContext->prevLeftVolume << 16;
493             LVM_INT32 incl = (((LVM_INT32)pContext->leftVolume << 16) - vl) / frameCount;
494             LVM_INT32 vr = (LVM_INT32)pContext->prevRightVolume << 16;
495             LVM_INT32 incr = (((LVM_INT32)pContext->rightVolume << 16) - vr) / frameCount;
496 
497             for (int i = 0; i < frameCount; i++) {
498                 OutFrames16[2*i] =
499                         clamp16((LVM_INT32)((vl >> 16) * OutFrames16[2*i]) >> 12);
500                 OutFrames16[2*i+1] =
501                         clamp16((LVM_INT32)((vr >> 16) * OutFrames16[2*i+1]) >> 12);
502 
503                 vl += incl;
504                 vr += incr;
505             }
506 
507             pContext->prevLeftVolume = pContext->leftVolume;
508             pContext->prevRightVolume = pContext->rightVolume;
509         } else if (pContext->volumeMode != REVERB_VOLUME_OFF) {
510             if (pContext->leftVolume != REVERB_UNIT_VOLUME ||
511                 pContext->rightVolume != REVERB_UNIT_VOLUME) {
512                 for (int i = 0; i < frameCount; i++) {
513                     OutFrames16[2*i] =
514                             clamp16((LVM_INT32)(pContext->leftVolume * OutFrames16[2*i]) >> 12);
515                     OutFrames16[2*i+1] =
516                             clamp16((LVM_INT32)(pContext->rightVolume * OutFrames16[2*i+1]) >> 12);
517                 }
518             }
519             pContext->prevLeftVolume = pContext->leftVolume;
520             pContext->prevRightVolume = pContext->rightVolume;
521             pContext->volumeMode = REVERB_VOLUME_RAMP;
522         }
523     }
524 
525     #ifdef LVM_PCM
526     fwrite(OutFrames16, frameCount*sizeof(LVM_INT16)*2, 1, pContext->PcmOutPtr);
527     fflush(pContext->PcmOutPtr);
528     #endif
529 
530     // Accumulate if required
531     if (pContext->config.outputCfg.accessMode == EFFECT_BUFFER_ACCESS_ACCUMULATE){
532         //LOGV("\tBuffer access is ACCUMULATE");
533         for (int i=0; i<frameCount*2; i++){ //always stereo here
534             pOut[i] = clamp16((int32_t)pOut[i] + (int32_t)OutFrames16[i]);
535         }
536     }else{
537         //LOGV("\tBuffer access is WRITE");
538         memcpy(pOut, OutFrames16, frameCount*sizeof(LVM_INT16)*2);
539     }
540 
541     return 0;
542 }    /* end process */
543 
544 //----------------------------------------------------------------------------
545 // Reverb_free()
546 //----------------------------------------------------------------------------
547 // Purpose: Free all memory associated with the Bundle.
548 //
549 // Inputs:
550 //  pContext:   effect engine context
551 //
552 // Outputs:
553 //
554 //----------------------------------------------------------------------------
555 
Reverb_free(ReverbContext * pContext)556 void Reverb_free(ReverbContext *pContext){
557 
558     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;         /* Function call status */
559     LVREV_ControlParams_st    params;                        /* Control Parameters */
560     LVREV_MemoryTable_st      MemTab;
561 
562     /* Free the algorithm memory */
563     LvmStatus = LVREV_GetMemoryTable(pContext->hInstance,
564                                    &MemTab,
565                                    LVM_NULL);
566 
567     LVM_ERROR_CHECK(LvmStatus, "LVM_GetMemoryTable", "Reverb_free")
568 
569     for (int i=0; i<LVM_NR_MEMORY_REGIONS; i++){
570         if (MemTab.Region[i].Size != 0){
571             if (MemTab.Region[i].pBaseAddress != NULL){
572                 LOGV("\tfree() - START freeing %ld bytes for region %u at %p\n",
573                         MemTab.Region[i].Size, i, MemTab.Region[i].pBaseAddress);
574 
575                 free(MemTab.Region[i].pBaseAddress);
576 
577                 LOGV("\tfree() - END   freeing %ld bytes for region %u at %p\n",
578                         MemTab.Region[i].Size, i, MemTab.Region[i].pBaseAddress);
579             }else{
580                 LOGV("\tLVM_ERROR : free() - trying to free with NULL pointer %ld bytes "
581                         "for region %u at %p ERROR\n",
582                         MemTab.Region[i].Size, i, MemTab.Region[i].pBaseAddress);
583             }
584         }
585     }
586 }    /* end Reverb_free */
587 
588 //----------------------------------------------------------------------------
589 // Reverb_configure()
590 //----------------------------------------------------------------------------
591 // Purpose: Set input and output audio configuration.
592 //
593 // Inputs:
594 //  pContext:   effect engine context
595 //  pConfig:    pointer to effect_config_t structure holding input and output
596 //      configuration parameters
597 //
598 // Outputs:
599 //
600 //----------------------------------------------------------------------------
601 
Reverb_configure(ReverbContext * pContext,effect_config_t * pConfig)602 int Reverb_configure(ReverbContext *pContext, effect_config_t *pConfig){
603     LVM_Fs_en   SampleRate;
604     //LOGV("\tReverb_configure start");
605 
606     CHECK_ARG(pContext != NULL);
607     CHECK_ARG(pConfig != NULL);
608 
609     CHECK_ARG(pConfig->inputCfg.samplingRate == pConfig->outputCfg.samplingRate);
610     CHECK_ARG(pConfig->inputCfg.format == pConfig->outputCfg.format);
611     CHECK_ARG((pContext->auxiliary && pConfig->inputCfg.channels == CHANNEL_MONO) ||
612               ((!pContext->auxiliary) && pConfig->inputCfg.channels == CHANNEL_STEREO));
613     CHECK_ARG(pConfig->outputCfg.channels == CHANNEL_STEREO);
614     CHECK_ARG(pConfig->outputCfg.accessMode == EFFECT_BUFFER_ACCESS_WRITE
615               || pConfig->outputCfg.accessMode == EFFECT_BUFFER_ACCESS_ACCUMULATE);
616     CHECK_ARG(pConfig->inputCfg.format == SAMPLE_FORMAT_PCM_S15);
617 
618     if(pConfig->inputCfg.samplingRate != 44100){
619         return -EINVAL;
620     }
621 
622     //LOGV("\tReverb_configure calling memcpy");
623     memcpy(&pContext->config, pConfig, sizeof(effect_config_t));
624 
625 
626     switch (pConfig->inputCfg.samplingRate) {
627     case 8000:
628         SampleRate = LVM_FS_8000;
629         break;
630     case 16000:
631         SampleRate = LVM_FS_16000;
632         break;
633     case 22050:
634         SampleRate = LVM_FS_22050;
635         break;
636     case 32000:
637         SampleRate = LVM_FS_32000;
638         break;
639     case 44100:
640         SampleRate = LVM_FS_44100;
641         break;
642     case 48000:
643         SampleRate = LVM_FS_48000;
644         break;
645     default:
646         LOGV("\rReverb_Configure invalid sampling rate %d", pConfig->inputCfg.samplingRate);
647         return -EINVAL;
648     }
649 
650     if(pContext->SampleRate != SampleRate){
651 
652         LVREV_ControlParams_st    ActiveParams;
653         LVREV_ReturnStatus_en     LvmStatus = LVREV_SUCCESS;
654 
655         //LOGV("\tReverb_configure change sampling rate to %d", SampleRate);
656 
657         /* Get the current settings */
658         LvmStatus = LVREV_GetControlParameters(pContext->hInstance,
659                                          &ActiveParams);
660 
661         LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "Reverb_configure")
662         if(LvmStatus != LVREV_SUCCESS) return -EINVAL;
663 
664         LvmStatus = LVREV_SetControlParameters(pContext->hInstance, &ActiveParams);
665 
666         LVM_ERROR_CHECK(LvmStatus, "LVREV_SetControlParameters", "Reverb_configure")
667         //LOGV("\tReverb_configure Succesfully called LVREV_SetControlParameters\n");
668 
669     }else{
670         //LOGV("\tReverb_configure keep sampling rate at %d", SampleRate);
671     }
672 
673     //LOGV("\tReverb_configure End");
674     return 0;
675 }   /* end Reverb_configure */
676 
677 
678 //----------------------------------------------------------------------------
679 // Reverb_init()
680 //----------------------------------------------------------------------------
681 // Purpose: Initialize engine with default configuration
682 //
683 // Inputs:
684 //  pContext:   effect engine context
685 //
686 // Outputs:
687 //
688 //----------------------------------------------------------------------------
689 
Reverb_init(ReverbContext * pContext)690 int Reverb_init(ReverbContext *pContext){
691     int status;
692 
693     LOGV("\tReverb_init start");
694 
695     CHECK_ARG(pContext != NULL);
696 
697     if (pContext->hInstance != NULL){
698         Reverb_free(pContext);
699     }
700 
701     pContext->config.inputCfg.accessMode                    = EFFECT_BUFFER_ACCESS_READ;
702     if (pContext->auxiliary) {
703         pContext->config.inputCfg.channels                  = CHANNEL_MONO;
704     } else {
705         pContext->config.inputCfg.channels                  = CHANNEL_STEREO;
706     }
707 
708     pContext->config.inputCfg.format                        = SAMPLE_FORMAT_PCM_S15;
709     pContext->config.inputCfg.samplingRate                  = 44100;
710     pContext->config.inputCfg.bufferProvider.getBuffer      = NULL;
711     pContext->config.inputCfg.bufferProvider.releaseBuffer  = NULL;
712     pContext->config.inputCfg.bufferProvider.cookie         = NULL;
713     pContext->config.inputCfg.mask                          = EFFECT_CONFIG_ALL;
714     pContext->config.outputCfg.accessMode                   = EFFECT_BUFFER_ACCESS_ACCUMULATE;
715     pContext->config.outputCfg.channels                     = CHANNEL_STEREO;
716     pContext->config.outputCfg.format                       = SAMPLE_FORMAT_PCM_S15;
717     pContext->config.outputCfg.samplingRate                 = 44100;
718     pContext->config.outputCfg.bufferProvider.getBuffer     = NULL;
719     pContext->config.outputCfg.bufferProvider.releaseBuffer = NULL;
720     pContext->config.outputCfg.bufferProvider.cookie        = NULL;
721     pContext->config.outputCfg.mask                         = EFFECT_CONFIG_ALL;
722 
723     pContext->leftVolume = REVERB_UNIT_VOLUME;
724     pContext->rightVolume = REVERB_UNIT_VOLUME;
725     pContext->prevLeftVolume = REVERB_UNIT_VOLUME;
726     pContext->prevRightVolume = REVERB_UNIT_VOLUME;
727     pContext->volumeMode = REVERB_VOLUME_FLAT;
728 
729     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;        /* Function call status */
730     LVREV_ControlParams_st    params;                         /* Control Parameters */
731     LVREV_InstanceParams_st   InstParams;                     /* Instance parameters */
732     LVREV_MemoryTable_st      MemTab;                         /* Memory allocation table */
733     bool                      bMallocFailure = LVM_FALSE;
734 
735     /* Set the capabilities */
736     InstParams.MaxBlockSize  = MAX_CALL_SIZE;
737     InstParams.SourceFormat  = LVM_STEREO;          // Max format, could be mono during process
738     InstParams.NumDelays     = LVREV_DELAYLINES_4;
739 
740     /* Allocate memory, forcing alignment */
741     LvmStatus = LVREV_GetMemoryTable(LVM_NULL,
742                                   &MemTab,
743                                   &InstParams);
744 
745     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetMemoryTable", "Reverb_init")
746     if(LvmStatus != LVREV_SUCCESS) return -EINVAL;
747 
748     LOGV("\tCreateInstance Succesfully called LVM_GetMemoryTable\n");
749 
750     /* Allocate memory */
751     for (int i=0; i<LVM_NR_MEMORY_REGIONS; i++){
752         if (MemTab.Region[i].Size != 0){
753             MemTab.Region[i].pBaseAddress = malloc(MemTab.Region[i].Size);
754 
755             if (MemTab.Region[i].pBaseAddress == LVM_NULL){
756                 LOGV("\tLVREV_ERROR :Reverb_init CreateInstance Failed to allocate %ld "
757                         "bytes for region %u\n", MemTab.Region[i].Size, i );
758                 bMallocFailure = LVM_TRUE;
759             }else{
760                 LOGV("\tReverb_init CreateInstance allocate %ld bytes for region %u at %p\n",
761                         MemTab.Region[i].Size, i, MemTab.Region[i].pBaseAddress);
762             }
763         }
764     }
765 
766     /* If one or more of the memory regions failed to allocate, free the regions that were
767      * succesfully allocated and return with an error
768      */
769     if(bMallocFailure == LVM_TRUE){
770         for (int i=0; i<LVM_NR_MEMORY_REGIONS; i++){
771             if (MemTab.Region[i].pBaseAddress == LVM_NULL){
772                 LOGV("\tLVM_ERROR :Reverb_init CreateInstance Failed to allocate %ld bytes "
773                         "for region %u - Not freeing\n", MemTab.Region[i].Size, i );
774             }else{
775                 LOGV("\tLVM_ERROR :Reverb_init CreateInstance Failed: but allocated %ld bytes "
776                         "for region %u at %p- free\n",
777                         MemTab.Region[i].Size, i, MemTab.Region[i].pBaseAddress);
778                 free(MemTab.Region[i].pBaseAddress);
779             }
780         }
781         return -EINVAL;
782     }
783     LOGV("\tReverb_init CreateInstance Succesfully malloc'd memory\n");
784 
785     /* Initialise */
786     pContext->hInstance = LVM_NULL;
787 
788     /* Init sets the instance handle */
789     LvmStatus = LVREV_GetInstanceHandle(&pContext->hInstance,
790                                         &MemTab,
791                                         &InstParams);
792 
793     LVM_ERROR_CHECK(LvmStatus, "LVM_GetInstanceHandle", "Reverb_init")
794     if(LvmStatus != LVREV_SUCCESS) return -EINVAL;
795 
796     LOGV("\tReverb_init CreateInstance Succesfully called LVM_GetInstanceHandle\n");
797 
798     /* Set the initial process parameters */
799     /* General parameters */
800     params.OperatingMode  = LVM_MODE_ON;
801     params.SampleRate     = LVM_FS_44100;
802 
803     if(pContext->config.inputCfg.channels == CHANNEL_MONO){
804         params.SourceFormat   = LVM_MONO;
805     } else {
806         params.SourceFormat   = LVM_STEREO;
807     }
808 
809     /* Reverb parameters */
810     params.Level          = 0;
811     params.LPF            = 23999;
812     params.HPF            = 50;
813     params.T60            = 1490;
814     params.Density        = 100;
815     params.Damping        = 21;
816     params.RoomSize       = 100;
817 
818     pContext->SamplesToExitCount = (params.T60 * pContext->config.inputCfg.samplingRate)/1000;
819 
820     /* Saved strength is used to return the exact strength that was used in the set to the get
821      * because we map the original strength range of 0:1000 to 1:15, and this will avoid
822      * quantisation like effect when returning
823      */
824     pContext->SavedRoomLevel    = -6000;
825     pContext->SavedHfLevel      = 0;
826     pContext->bEnabled          = LVM_FALSE;
827     pContext->SavedDecayTime    = params.T60;
828     pContext->SavedDecayHfRatio = params.Damping*20;
829     pContext->SavedDensity      = params.RoomSize*10;
830     pContext->SavedDiffusion    = params.Density*10;
831     pContext->SavedReverbLevel  = -6000;
832 
833     /* Activate the initial settings */
834     LvmStatus = LVREV_SetControlParameters(pContext->hInstance,
835                                          &params);
836 
837     LVM_ERROR_CHECK(LvmStatus, "LVREV_SetControlParameters", "Reverb_init")
838     if(LvmStatus != LVREV_SUCCESS) return -EINVAL;
839 
840     LOGV("\tReverb_init CreateInstance Succesfully called LVREV_SetControlParameters\n");
841     LOGV("\tReverb_init End");
842     return 0;
843 }   /* end Reverb_init */
844 
845 //----------------------------------------------------------------------------
846 // ReverbConvertLevel()
847 //----------------------------------------------------------------------------
848 // Purpose:
849 // Convert level from OpenSL ES format to LVM format
850 //
851 // Inputs:
852 //  level       level to be applied
853 //
854 //----------------------------------------------------------------------------
855 
ReverbConvertLevel(int16_t level)856 int16_t ReverbConvertLevel(int16_t level){
857     static int16_t LevelArray[101] =
858     {
859        -12000, -4000,  -3398,  -3046,  -2796,  -2603,  -2444,  -2310,  -2194,  -2092,
860        -2000,  -1918,  -1842,  -1773,  -1708,  -1648,  -1592,  -1540,  -1490,  -1443,
861        -1398,  -1356,  -1316,  -1277,  -1240,  -1205,  -1171,  -1138,  -1106,  -1076,
862        -1046,  -1018,  -990,   -963,   -938,   -912,   -888,   -864,   -841,   -818,
863        -796,   -775,   -754,   -734,   -714,   -694,   -675,   -656,   -638,   -620,
864        -603,   -585,   -568,   -552,   -536,   -520,   -504,   -489,   -474,   -459,
865        -444,   -430,   -416,   -402,   -388,   -375,   -361,   -348,   -335,   -323,
866        -310,   -298,   -286,   -274,   -262,   -250,   -239,   -228,   -216,   -205,
867        -194,   -184,   -173,   -162,   -152,   -142,   -132,   -121,   -112,   -102,
868        -92,    -82,    -73,    -64,    -54,    -45,    -36,    -27,    -18,    -9,
869        0
870     };
871     int16_t i;
872 
873     for(i = 0; i < 101; i++)
874     {
875        if(level <= LevelArray[i])
876            break;
877     }
878     return i;
879 }
880 
881 //----------------------------------------------------------------------------
882 // ReverbConvertHFLevel()
883 //----------------------------------------------------------------------------
884 // Purpose:
885 // Convert level from OpenSL ES format to LVM format
886 //
887 // Inputs:
888 //  level       level to be applied
889 //
890 //----------------------------------------------------------------------------
891 
ReverbConvertHfLevel(int16_t Hflevel)892 int16_t ReverbConvertHfLevel(int16_t Hflevel){
893     int16_t i;
894 
895     static LPFPair_t LPFArray[97] =
896     {   // Limit range to 50 for LVREV parameter range
897         {-10000, 50}, { -5000, 50 }, { -4000, 50},  { -3000, 158}, { -2000, 502},
898         {-1000, 1666},{ -900, 1897}, { -800, 2169}, { -700, 2496}, { -600, 2895},
899         {-500, 3400}, { -400, 4066}, { -300, 5011}, { -200, 6537}, { -100,  9826},
900         {-99, 9881 }, { -98, 9937 }, { -97, 9994 }, { -96, 10052}, { -95, 10111},
901         {-94, 10171}, { -93, 10231}, { -92, 10293}, { -91, 10356}, { -90, 10419},
902         {-89, 10484}, { -88, 10549}, { -87, 10616}, { -86, 10684}, { -85, 10753},
903         {-84, 10823}, { -83, 10895}, { -82, 10968}, { -81, 11042}, { -80, 11117},
904         {-79, 11194}, { -78, 11272}, { -77, 11352}, { -76, 11433}, { -75, 11516},
905         {-74, 11600}, { -73, 11686}, { -72, 11774}, { -71, 11864}, { -70, 11955},
906         {-69, 12049}, { -68, 12144}, { -67, 12242}, { -66, 12341}, { -65, 12443},
907         {-64, 12548}, { -63, 12654}, { -62, 12763}, { -61, 12875}, { -60, 12990},
908         {-59, 13107}, { -58, 13227}, { -57, 13351}, { -56, 13477}, { -55, 13607},
909         {-54, 13741}, { -53, 13878}, { -52, 14019}, { -51, 14164}, { -50, 14313},
910         {-49, 14467}, { -48, 14626}, { -47, 14789}, { -46, 14958}, { -45, 15132},
911         {-44, 15312}, { -43, 15498}, { -42, 15691}, { -41, 15890}, { -40, 16097},
912         {-39, 16311}, { -38, 16534}, { -37, 16766}, { -36, 17007}, { -35, 17259},
913         {-34, 17521}, { -33, 17795}, { -32, 18081}, { -31, 18381}, { -30, 18696},
914         {-29, 19027}, { -28, 19375}, { -27, 19742}, { -26, 20129}, { -25, 20540},
915         {-24, 20976}, { -23, 21439}, { -22, 21934}, { -21, 22463}, { -20, 23031},
916         {-19, 23643}, { -18, 23999}
917     };
918 
919     for(i = 0; i < 96; i++)
920     {
921         if(Hflevel <= LPFArray[i].Room_HF)
922             break;
923     }
924     return LPFArray[i].LPF;
925 }
926 
927 //----------------------------------------------------------------------------
928 // ReverbSetRoomHfLevel()
929 //----------------------------------------------------------------------------
930 // Purpose:
931 // Apply the HF level to the Reverb. Must first be converted to LVM format
932 //
933 // Inputs:
934 //  pContext:   effect engine context
935 //  level       level to be applied
936 //
937 //----------------------------------------------------------------------------
938 
ReverbSetRoomHfLevel(ReverbContext * pContext,int16_t level)939 void ReverbSetRoomHfLevel(ReverbContext *pContext, int16_t level){
940     //LOGV("\tReverbSetRoomHfLevel start (%d)", level);
941 
942     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
943     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
944 
945     /* Get the current settings */
946     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
947     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbSetRoomHfLevel")
948     //LOGV("\tReverbSetRoomHfLevel Succesfully returned from LVM_GetControlParameters\n");
949     //LOGV("\tReverbSetRoomHfLevel() just Got -> %d\n", ActiveParams.LPF);
950 
951     ActiveParams.LPF = ReverbConvertHfLevel(level);
952 
953     /* Activate the initial settings */
954     LvmStatus = LVREV_SetControlParameters(pContext->hInstance, &ActiveParams);
955     LVM_ERROR_CHECK(LvmStatus, "LVREV_SetControlParameters", "ReverbSetRoomHfLevel")
956     //LOGV("\tReverbSetRoomhfLevel() just Set -> %d\n", ActiveParams.LPF);
957     pContext->SavedHfLevel = level;
958     //LOGV("\tReverbSetHfRoomLevel end.. saving %d", pContext->SavedHfLevel);
959     return;
960 }
961 
962 //----------------------------------------------------------------------------
963 // ReverbGetRoomHfLevel()
964 //----------------------------------------------------------------------------
965 // Purpose:
966 // Get the level applied to the Revervb. Must first be converted to LVM format
967 //
968 // Inputs:
969 //  pContext:   effect engine context
970 //
971 //----------------------------------------------------------------------------
972 
ReverbGetRoomHfLevel(ReverbContext * pContext)973 int16_t ReverbGetRoomHfLevel(ReverbContext *pContext){
974     int16_t level;
975     //LOGV("\tReverbGetRoomHfLevel start, saved level is %d", pContext->SavedHfLevel);
976 
977     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
978     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
979 
980     /* Get the current settings */
981     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
982     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbGetRoomHfLevel")
983     //LOGV("\tReverbGetRoomHfLevel Succesfully returned from LVM_GetControlParameters\n");
984     //LOGV("\tReverbGetRoomHfLevel() just Got -> %d\n", ActiveParams.LPF);
985 
986     level = ReverbConvertHfLevel(pContext->SavedHfLevel);
987 
988     //LOGV("\tReverbGetRoomHfLevel() ActiveParams.LPFL %d, pContext->SavedHfLevel: %d, "
989     //     "converted level: %d\n", ActiveParams.LPF, pContext->SavedHfLevel, level);
990 
991     if(ActiveParams.LPF != level){
992         LOGV("\tLVM_ERROR : (ignore at start up) ReverbGetRoomHfLevel() has wrong level -> %d %d\n",
993                ActiveParams.Level, level);
994     }
995 
996     //LOGV("\tReverbGetRoomHfLevel end");
997     return pContext->SavedHfLevel;
998 }
999 
1000 //----------------------------------------------------------------------------
1001 // ReverbSetReverbLevel()
1002 //----------------------------------------------------------------------------
1003 // Purpose:
1004 // Apply the level to the Reverb. Must first be converted to LVM format
1005 //
1006 // Inputs:
1007 //  pContext:   effect engine context
1008 //  level       level to be applied
1009 //
1010 //----------------------------------------------------------------------------
1011 
ReverbSetReverbLevel(ReverbContext * pContext,int16_t level)1012 void ReverbSetReverbLevel(ReverbContext *pContext, int16_t level){
1013     //LOGV("\n\tReverbSetReverbLevel start (%d)", level);
1014 
1015     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1016     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
1017     LVM_INT32                 CombinedLevel;             // Sum of room and reverb level controls
1018 
1019     /* Get the current settings */
1020     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1021     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbSetReverbLevel")
1022     //LOGV("\tReverbSetReverbLevel Succesfully returned from LVM_GetControlParameters\n");
1023     //LOGV("\tReverbSetReverbLevel just Got -> %d\n", ActiveParams.Level);
1024 
1025     // needs to subtract max levels for both RoomLevel and ReverbLevel
1026     CombinedLevel = (level + pContext->SavedRoomLevel)-LVREV_MAX_REVERB_LEVEL;
1027     //LOGV("\tReverbSetReverbLevel() CombinedLevel is %d = %d + %d\n",
1028     //      CombinedLevel, level, pContext->SavedRoomLevel);
1029 
1030     ActiveParams.Level = ReverbConvertLevel(CombinedLevel);
1031 
1032     //LOGV("\tReverbSetReverbLevel() Trying to set -> %d\n", ActiveParams.Level);
1033 
1034     /* Activate the initial settings */
1035     LvmStatus = LVREV_SetControlParameters(pContext->hInstance, &ActiveParams);
1036     LVM_ERROR_CHECK(LvmStatus, "LVREV_SetControlParameters", "ReverbSetReverbLevel")
1037     //LOGV("\tReverbSetReverbLevel() just Set -> %d\n", ActiveParams.Level);
1038 
1039     pContext->SavedReverbLevel = level;
1040     //LOGV("\tReverbSetReverbLevel end pContext->SavedReverbLevel is %d\n\n",
1041     //     pContext->SavedReverbLevel);
1042     return;
1043 }
1044 
1045 //----------------------------------------------------------------------------
1046 // ReverbGetReverbLevel()
1047 //----------------------------------------------------------------------------
1048 // Purpose:
1049 // Get the level applied to the Revervb. Must first be converted to LVM format
1050 //
1051 // Inputs:
1052 //  pContext:   effect engine context
1053 //
1054 //----------------------------------------------------------------------------
1055 
ReverbGetReverbLevel(ReverbContext * pContext)1056 int16_t ReverbGetReverbLevel(ReverbContext *pContext){
1057     int16_t level;
1058     //LOGV("\tReverbGetReverbLevel start");
1059 
1060     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1061     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
1062     LVM_INT32                 CombinedLevel;             // Sum of room and reverb level controls
1063 
1064     /* Get the current settings */
1065     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1066     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbGetReverbLevel")
1067     //LOGV("\tReverbGetReverbLevel Succesfully returned from LVM_GetControlParameters\n");
1068     //LOGV("\tReverbGetReverbLevel() just Got -> %d\n", ActiveParams.Level);
1069 
1070     // needs to subtract max levels for both RoomLevel and ReverbLevel
1071     CombinedLevel = (pContext->SavedReverbLevel + pContext->SavedRoomLevel)-LVREV_MAX_REVERB_LEVEL;
1072 
1073     //LOGV("\tReverbGetReverbLevel() CombinedLevel is %d = %d + %d\n",
1074     //CombinedLevel, pContext->SavedReverbLevel, pContext->SavedRoomLevel);
1075     level = ReverbConvertLevel(CombinedLevel);
1076 
1077     //LOGV("\tReverbGetReverbLevel(): ActiveParams.Level: %d, pContext->SavedReverbLevel: %d, "
1078     //"pContext->SavedRoomLevel: %d, CombinedLevel: %d, converted level: %d\n",
1079     //ActiveParams.Level, pContext->SavedReverbLevel,pContext->SavedRoomLevel, CombinedLevel,level);
1080 
1081     if(ActiveParams.Level != level){
1082         LOGV("\tLVM_ERROR : (ignore at start up) ReverbGetReverbLevel() has wrong level -> %d %d\n",
1083                 ActiveParams.Level, level);
1084     }
1085 
1086     //LOGV("\tReverbGetReverbLevel end\n");
1087 
1088     return pContext->SavedReverbLevel;
1089 }
1090 
1091 //----------------------------------------------------------------------------
1092 // ReverbSetRoomLevel()
1093 //----------------------------------------------------------------------------
1094 // Purpose:
1095 // Apply the level to the Reverb. Must first be converted to LVM format
1096 //
1097 // Inputs:
1098 //  pContext:   effect engine context
1099 //  level       level to be applied
1100 //
1101 //----------------------------------------------------------------------------
1102 
ReverbSetRoomLevel(ReverbContext * pContext,int16_t level)1103 void ReverbSetRoomLevel(ReverbContext *pContext, int16_t level){
1104     //LOGV("\tReverbSetRoomLevel start (%d)", level);
1105 
1106     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1107     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
1108     LVM_INT32                 CombinedLevel;             // Sum of room and reverb level controls
1109 
1110     /* Get the current settings */
1111     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1112     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbSetRoomLevel")
1113     //LOGV("\tReverbSetRoomLevel Succesfully returned from LVM_GetControlParameters\n");
1114     //LOGV("\tReverbSetRoomLevel() just Got -> %d\n", ActiveParams.Level);
1115 
1116     // needs to subtract max levels for both RoomLevel and ReverbLevel
1117     CombinedLevel = (level + pContext->SavedReverbLevel)-LVREV_MAX_REVERB_LEVEL;
1118     ActiveParams.Level = ReverbConvertLevel(CombinedLevel);
1119 
1120     /* Activate the initial settings */
1121     LvmStatus = LVREV_SetControlParameters(pContext->hInstance, &ActiveParams);
1122     LVM_ERROR_CHECK(LvmStatus, "LVREV_SetControlParameters", "ReverbSetRoomLevel")
1123     //LOGV("\tReverbSetRoomLevel() just Set -> %d\n", ActiveParams.Level);
1124 
1125     pContext->SavedRoomLevel = level;
1126     //LOGV("\tReverbSetRoomLevel end");
1127     return;
1128 }
1129 
1130 //----------------------------------------------------------------------------
1131 // ReverbGetRoomLevel()
1132 //----------------------------------------------------------------------------
1133 // Purpose:
1134 // Get the level applied to the Revervb. Must first be converted to LVM format
1135 //
1136 // Inputs:
1137 //  pContext:   effect engine context
1138 //
1139 //----------------------------------------------------------------------------
1140 
ReverbGetRoomLevel(ReverbContext * pContext)1141 int16_t ReverbGetRoomLevel(ReverbContext *pContext){
1142     int16_t level;
1143     //LOGV("\tReverbGetRoomLevel start");
1144 
1145     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1146     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
1147     LVM_INT32                 CombinedLevel;             // Sum of room and reverb level controls
1148 
1149     /* Get the current settings */
1150     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1151     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbGetRoomLevel")
1152     //LOGV("\tReverbGetRoomLevel Succesfully returned from LVM_GetControlParameters\n");
1153     //LOGV("\tReverbGetRoomLevel() just Got -> %d\n", ActiveParams.Level);
1154 
1155     // needs to subtract max levels for both RoomLevel and ReverbLevel
1156     CombinedLevel = (pContext->SavedRoomLevel + pContext->SavedReverbLevel-LVREV_MAX_REVERB_LEVEL);
1157     level = ReverbConvertLevel(CombinedLevel);
1158 
1159     //LOGV("\tReverbGetRoomLevel, Level = %d, pContext->SavedRoomLevel = %d, "
1160     //     "pContext->SavedReverbLevel = %d, CombinedLevel = %d, level = %d",
1161     //     ActiveParams.Level, pContext->SavedRoomLevel,
1162     //     pContext->SavedReverbLevel, CombinedLevel, level);
1163 
1164     if(ActiveParams.Level != level){
1165         LOGV("\tLVM_ERROR : (ignore at start up) ReverbGetRoomLevel() has wrong level -> %d %d\n",
1166               ActiveParams.Level, level);
1167     }
1168 
1169     //LOGV("\tReverbGetRoomLevel end");
1170     return pContext->SavedRoomLevel;
1171 }
1172 
1173 //----------------------------------------------------------------------------
1174 // ReverbSetDecayTime()
1175 //----------------------------------------------------------------------------
1176 // Purpose:
1177 // Apply the decay time to the Reverb.
1178 //
1179 // Inputs:
1180 //  pContext:   effect engine context
1181 //  time        decay to be applied
1182 //
1183 //----------------------------------------------------------------------------
1184 
ReverbSetDecayTime(ReverbContext * pContext,uint32_t time)1185 void ReverbSetDecayTime(ReverbContext *pContext, uint32_t time){
1186     //LOGV("\tReverbSetDecayTime start (%d)", time);
1187 
1188     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1189     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
1190 
1191     /* Get the current settings */
1192     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1193     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbSetDecayTime")
1194     //LOGV("\tReverbSetDecayTime Succesfully returned from LVM_GetControlParameters\n");
1195     //LOGV("\tReverbSetDecayTime() just Got -> %d\n", ActiveParams.T60);
1196 
1197     if (time <= LVREV_MAX_T60) {
1198         ActiveParams.T60 = (LVM_UINT16)time;
1199     }
1200     else {
1201         ActiveParams.T60 = LVREV_MAX_T60;
1202     }
1203 
1204     /* Activate the initial settings */
1205     LvmStatus = LVREV_SetControlParameters(pContext->hInstance, &ActiveParams);
1206     LVM_ERROR_CHECK(LvmStatus, "LVREV_SetControlParameters", "ReverbSetDecayTime")
1207     //LOGV("\tReverbSetDecayTime() just Set -> %d\n", ActiveParams.T60);
1208 
1209     pContext->SamplesToExitCount = (ActiveParams.T60 * pContext->config.inputCfg.samplingRate)/1000;
1210     //LOGV("\tReverbSetDecayTime() just Set SamplesToExitCount-> %d\n",pContext->SamplesToExitCount);
1211     pContext->SavedDecayTime = (int16_t)time;
1212     //LOGV("\tReverbSetDecayTime end");
1213     return;
1214 }
1215 
1216 //----------------------------------------------------------------------------
1217 // ReverbGetDecayTime()
1218 //----------------------------------------------------------------------------
1219 // Purpose:
1220 // Get the decay time applied to the Revervb.
1221 //
1222 // Inputs:
1223 //  pContext:   effect engine context
1224 //
1225 //----------------------------------------------------------------------------
1226 
ReverbGetDecayTime(ReverbContext * pContext)1227 uint32_t ReverbGetDecayTime(ReverbContext *pContext){
1228     //LOGV("\tReverbGetDecayTime start");
1229 
1230     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1231     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
1232 
1233     /* Get the current settings */
1234     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1235     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbGetDecayTime")
1236     //LOGV("\tReverbGetDecayTime Succesfully returned from LVM_GetControlParameters\n");
1237     //LOGV("\tReverbGetDecayTime() just Got -> %d\n", ActiveParams.T60);
1238 
1239     if(ActiveParams.T60 != pContext->SavedDecayTime){
1240         // This will fail if the decay time is set to more than 7000
1241         LOGV("\tLVM_ERROR : ReverbGetDecayTime() has wrong level -> %d %d\n",
1242          ActiveParams.T60, pContext->SavedDecayTime);
1243     }
1244 
1245     //LOGV("\tReverbGetDecayTime end");
1246     return (uint32_t)ActiveParams.T60;
1247 }
1248 
1249 //----------------------------------------------------------------------------
1250 // ReverbSetDecayHfRatio()
1251 //----------------------------------------------------------------------------
1252 // Purpose:
1253 // Apply the HF decay ratio to the Reverb.
1254 //
1255 // Inputs:
1256 //  pContext:   effect engine context
1257 //  ratio       ratio to be applied
1258 //
1259 //----------------------------------------------------------------------------
1260 
ReverbSetDecayHfRatio(ReverbContext * pContext,int16_t ratio)1261 void ReverbSetDecayHfRatio(ReverbContext *pContext, int16_t ratio){
1262     //LOGV("\tReverbSetDecayHfRatioe start (%d)", ratio);
1263 
1264     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1265     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;   /* Function call status */
1266 
1267     /* Get the current settings */
1268     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1269     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbSetDecayHfRatio")
1270     //LOGV("\tReverbSetDecayHfRatio Succesfully returned from LVM_GetControlParameters\n");
1271     //LOGV("\tReverbSetDecayHfRatio() just Got -> %d\n", ActiveParams.Damping);
1272 
1273     ActiveParams.Damping = (LVM_INT16)(ratio/20);
1274 
1275     /* Activate the initial settings */
1276     LvmStatus = LVREV_SetControlParameters(pContext->hInstance, &ActiveParams);
1277     LVM_ERROR_CHECK(LvmStatus, "LVREV_SetControlParameters", "ReverbSetDecayHfRatio")
1278     //LOGV("\tReverbSetDecayHfRatio() just Set -> %d\n", ActiveParams.Damping);
1279 
1280     pContext->SavedDecayHfRatio = ratio;
1281     //LOGV("\tReverbSetDecayHfRatio end");
1282     return;
1283 }
1284 
1285 //----------------------------------------------------------------------------
1286 // ReverbGetDecayHfRatio()
1287 //----------------------------------------------------------------------------
1288 // Purpose:
1289 // Get the HF decay ratio applied to the Revervb.
1290 //
1291 // Inputs:
1292 //  pContext:   effect engine context
1293 //
1294 //----------------------------------------------------------------------------
1295 
ReverbGetDecayHfRatio(ReverbContext * pContext)1296 int32_t ReverbGetDecayHfRatio(ReverbContext *pContext){
1297     //LOGV("\tReverbGetDecayHfRatio start");
1298 
1299     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1300     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;   /* Function call status */
1301 
1302     /* Get the current settings */
1303     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1304     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbGetDecayHfRatio")
1305     //LOGV("\tReverbGetDecayHfRatio Succesfully returned from LVM_GetControlParameters\n");
1306     //LOGV("\tReverbGetDecayHfRatio() just Got -> %d\n", ActiveParams.Damping);
1307 
1308     if(ActiveParams.Damping != (LVM_INT16)(pContext->SavedDecayHfRatio / 20)){
1309         LOGV("\tLVM_ERROR : ReverbGetDecayHfRatio() has wrong level -> %d %d\n",
1310          ActiveParams.Damping, pContext->SavedDecayHfRatio);
1311     }
1312 
1313     //LOGV("\tReverbGetDecayHfRatio end");
1314     return pContext->SavedDecayHfRatio;
1315 }
1316 
1317 //----------------------------------------------------------------------------
1318 // ReverbSetDiffusion()
1319 //----------------------------------------------------------------------------
1320 // Purpose:
1321 // Apply the diffusion to the Reverb.
1322 //
1323 // Inputs:
1324 //  pContext:   effect engine context
1325 //  level        decay to be applied
1326 //
1327 //----------------------------------------------------------------------------
1328 
ReverbSetDiffusion(ReverbContext * pContext,int16_t level)1329 void ReverbSetDiffusion(ReverbContext *pContext, int16_t level){
1330     //LOGV("\tReverbSetDiffusion start (%d)", level);
1331 
1332     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1333     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
1334 
1335     /* Get the current settings */
1336     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1337     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbSetDiffusion")
1338     //LOGV("\tReverbSetDiffusion Succesfully returned from LVM_GetControlParameters\n");
1339     //LOGV("\tReverbSetDiffusion() just Got -> %d\n", ActiveParams.Density);
1340 
1341     ActiveParams.Density = (LVM_INT16)(level/10);
1342 
1343     /* Activate the initial settings */
1344     LvmStatus = LVREV_SetControlParameters(pContext->hInstance, &ActiveParams);
1345     LVM_ERROR_CHECK(LvmStatus, "LVREV_SetControlParameters", "ReverbSetDiffusion")
1346     //LOGV("\tReverbSetDiffusion() just Set -> %d\n", ActiveParams.Density);
1347 
1348     pContext->SavedDiffusion = level;
1349     //LOGV("\tReverbSetDiffusion end");
1350     return;
1351 }
1352 
1353 //----------------------------------------------------------------------------
1354 // ReverbGetDiffusion()
1355 //----------------------------------------------------------------------------
1356 // Purpose:
1357 // Get the decay time applied to the Revervb.
1358 //
1359 // Inputs:
1360 //  pContext:   effect engine context
1361 //
1362 //----------------------------------------------------------------------------
1363 
ReverbGetDiffusion(ReverbContext * pContext)1364 int32_t ReverbGetDiffusion(ReverbContext *pContext){
1365     //LOGV("\tReverbGetDiffusion start");
1366 
1367     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1368     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
1369     LVM_INT16                 Temp;
1370 
1371     /* Get the current settings */
1372     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1373     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbGetDiffusion")
1374     //LOGV("\tReverbGetDiffusion Succesfully returned from LVM_GetControlParameters\n");
1375     //LOGV("\tReverbGetDiffusion just Got -> %d\n", ActiveParams.Density);
1376 
1377     Temp = (LVM_INT16)(pContext->SavedDiffusion/10);
1378 
1379     if(ActiveParams.Density != Temp){
1380         LOGV("\tLVM_ERROR : ReverbGetDiffusion invalid value %d %d", Temp, ActiveParams.Density);
1381     }
1382 
1383     //LOGV("\tReverbGetDiffusion end");
1384     return pContext->SavedDiffusion;
1385 }
1386 
1387 //----------------------------------------------------------------------------
1388 // ReverbSetDensity()
1389 //----------------------------------------------------------------------------
1390 // Purpose:
1391 // Apply the density level the Reverb.
1392 //
1393 // Inputs:
1394 //  pContext:   effect engine context
1395 //  level        decay to be applied
1396 //
1397 //----------------------------------------------------------------------------
1398 
ReverbSetDensity(ReverbContext * pContext,int16_t level)1399 void ReverbSetDensity(ReverbContext *pContext, int16_t level){
1400     //LOGV("\tReverbSetDensity start (%d)", level);
1401 
1402     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1403     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
1404 
1405     /* Get the current settings */
1406     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1407     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbSetDensity")
1408     //LOGV("\tReverbSetDensity Succesfully returned from LVM_GetControlParameters\n");
1409     //LOGV("\tReverbSetDensity just Got -> %d\n", ActiveParams.RoomSize);
1410 
1411     ActiveParams.RoomSize = (LVM_INT16)(((level * 99) / 1000) + 1);
1412 
1413     /* Activate the initial settings */
1414     LvmStatus = LVREV_SetControlParameters(pContext->hInstance, &ActiveParams);
1415     LVM_ERROR_CHECK(LvmStatus, "LVREV_SetControlParameters", "ReverbSetDensity")
1416     //LOGV("\tReverbSetDensity just Set -> %d\n", ActiveParams.RoomSize);
1417 
1418     pContext->SavedDensity = level;
1419     //LOGV("\tReverbSetDensity end");
1420     return;
1421 }
1422 
1423 //----------------------------------------------------------------------------
1424 // ReverbGetDensity()
1425 //----------------------------------------------------------------------------
1426 // Purpose:
1427 // Get the density level applied to the Revervb.
1428 //
1429 // Inputs:
1430 //  pContext:   effect engine context
1431 //
1432 //----------------------------------------------------------------------------
1433 
ReverbGetDensity(ReverbContext * pContext)1434 int32_t ReverbGetDensity(ReverbContext *pContext){
1435     //LOGV("\tReverbGetDensity start");
1436 
1437     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1438     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
1439     LVM_INT16                 Temp;
1440     /* Get the current settings */
1441     LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
1442     LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "ReverbGetDensity")
1443     //LOGV("\tReverbGetDensity Succesfully returned from LVM_GetControlParameters\n");
1444     //LOGV("\tReverbGetDensity() just Got -> %d\n", ActiveParams.RoomSize);
1445 
1446 
1447     Temp = (LVM_INT16)(((pContext->SavedDensity * 99) / 1000) + 1);
1448 
1449     if(Temp != ActiveParams.RoomSize){
1450         LOGV("\tLVM_ERROR : ReverbGetDensity invalid value %d %d", Temp, ActiveParams.RoomSize);
1451     }
1452 
1453     //LOGV("\tReverbGetDensity end");
1454     return pContext->SavedDensity;
1455 }
1456 
1457 //----------------------------------------------------------------------------
1458 // Reverb_LoadPreset()
1459 //----------------------------------------------------------------------------
1460 // Purpose:
1461 // Load a the next preset
1462 //
1463 // Inputs:
1464 //  pContext         - handle to instance data
1465 //
1466 // Outputs:
1467 //
1468 // Side Effects:
1469 //
1470 //----------------------------------------------------------------------------
Reverb_LoadPreset(ReverbContext * pContext)1471 int Reverb_LoadPreset(ReverbContext   *pContext)
1472 {
1473     //TODO: add reflections delay, level and reverb delay when early reflections are
1474     // implemented
1475     pContext->curPreset = pContext->nextPreset;
1476 
1477     if (pContext->curPreset != REVERB_PRESET_NONE) {
1478         const t_reverb_settings *preset = &sReverbPresets[pContext->curPreset];
1479         ReverbSetRoomLevel(pContext, preset->roomLevel);
1480         ReverbSetRoomHfLevel(pContext, preset->roomHFLevel);
1481         ReverbSetDecayTime(pContext, preset->decayTime);
1482         ReverbSetDecayHfRatio(pContext, preset->decayHFRatio);
1483         //reflectionsLevel
1484         //reflectionsDelay
1485         ReverbSetReverbLevel(pContext, preset->reverbLevel);
1486         // reverbDelay
1487         ReverbSetDiffusion(pContext, preset->diffusion);
1488         ReverbSetDensity(pContext, preset->density);
1489     }
1490 
1491     return 0;
1492 }
1493 
1494 
1495 //----------------------------------------------------------------------------
1496 // Reverb_getParameter()
1497 //----------------------------------------------------------------------------
1498 // Purpose:
1499 // Get a Reverb parameter
1500 //
1501 // Inputs:
1502 //  pContext         - handle to instance data
1503 //  pParam           - pointer to parameter
1504 //  pValue           - pointer to variable to hold retrieved value
1505 //  pValueSize       - pointer to value size: maximum size as input
1506 //
1507 // Outputs:
1508 //  *pValue updated with parameter value
1509 //  *pValueSize updated with actual value size
1510 //
1511 //
1512 // Side Effects:
1513 //
1514 //----------------------------------------------------------------------------
1515 
Reverb_getParameter(ReverbContext * pContext,void * pParam,size_t * pValueSize,void * pValue)1516 int Reverb_getParameter(ReverbContext *pContext,
1517                         void          *pParam,
1518                         size_t        *pValueSize,
1519                         void          *pValue){
1520     int status = 0;
1521     int32_t *pParamTemp = (int32_t *)pParam;
1522     int32_t param = *pParamTemp++;
1523     char *name;
1524     t_reverb_settings *pProperties;
1525 
1526     //LOGV("\tReverb_getParameter start");
1527     if (pContext->preset) {
1528         if (param != REVERB_PARAM_PRESET || *pValueSize < sizeof(uint16_t)) {
1529             return -EINVAL;
1530         }
1531 
1532         *(uint16_t *)pValue = pContext->nextPreset;
1533         LOGV("get REVERB_PARAM_PRESET, preset %d", pContext->nextPreset);
1534         return 0;
1535     }
1536 
1537     switch (param){
1538         case REVERB_PARAM_ROOM_LEVEL:
1539             if (*pValueSize != sizeof(int16_t)){
1540                 LOGV("\tLVM_ERROR : Reverb_getParameter() invalid pValueSize1 %d", *pValueSize);
1541                 return -EINVAL;
1542             }
1543             *pValueSize = sizeof(int16_t);
1544             break;
1545         case REVERB_PARAM_ROOM_HF_LEVEL:
1546             if (*pValueSize != sizeof(int16_t)){
1547                 LOGV("\tLVM_ERROR : Reverb_getParameter() invalid pValueSize12 %d", *pValueSize);
1548                 return -EINVAL;
1549             }
1550             *pValueSize = sizeof(int16_t);
1551             break;
1552         case REVERB_PARAM_DECAY_TIME:
1553             if (*pValueSize != sizeof(uint32_t)){
1554                 LOGV("\tLVM_ERROR : Reverb_getParameter() invalid pValueSize3 %d", *pValueSize);
1555                 return -EINVAL;
1556             }
1557             *pValueSize = sizeof(uint32_t);
1558             break;
1559         case REVERB_PARAM_DECAY_HF_RATIO:
1560             if (*pValueSize != sizeof(int16_t)){
1561                 LOGV("\tLVM_ERROR : Reverb_getParameter() invalid pValueSize4 %d", *pValueSize);
1562                 return -EINVAL;
1563             }
1564             *pValueSize = sizeof(int16_t);
1565             break;
1566         case REVERB_PARAM_REFLECTIONS_LEVEL:
1567             if (*pValueSize != sizeof(int16_t)){
1568                 LOGV("\tLVM_ERROR : Reverb_getParameter() invalid pValueSize5 %d", *pValueSize);
1569                 return -EINVAL;
1570             }
1571             *pValueSize = sizeof(int16_t);
1572             break;
1573         case REVERB_PARAM_REFLECTIONS_DELAY:
1574             if (*pValueSize != sizeof(uint32_t)){
1575                 LOGV("\tLVM_ERROR : Reverb_getParameter() invalid pValueSize6 %d", *pValueSize);
1576                 return -EINVAL;
1577             }
1578             *pValueSize = sizeof(uint32_t);
1579             break;
1580         case REVERB_PARAM_REVERB_LEVEL:
1581             if (*pValueSize != sizeof(int16_t)){
1582                 LOGV("\tLVM_ERROR : Reverb_getParameter() invalid pValueSize7 %d", *pValueSize);
1583                 return -EINVAL;
1584             }
1585             *pValueSize = sizeof(int16_t);
1586             break;
1587         case REVERB_PARAM_REVERB_DELAY:
1588             if (*pValueSize != sizeof(uint32_t)){
1589                 LOGV("\tLVM_ERROR : Reverb_getParameter() invalid pValueSize8 %d", *pValueSize);
1590                 return -EINVAL;
1591             }
1592             *pValueSize = sizeof(uint32_t);
1593             break;
1594         case REVERB_PARAM_DIFFUSION:
1595             if (*pValueSize != sizeof(int16_t)){
1596                 LOGV("\tLVM_ERROR : Reverb_getParameter() invalid pValueSize9 %d", *pValueSize);
1597                 return -EINVAL;
1598             }
1599             *pValueSize = sizeof(int16_t);
1600             break;
1601         case REVERB_PARAM_DENSITY:
1602             if (*pValueSize != sizeof(int16_t)){
1603                 LOGV("\tLVM_ERROR : Reverb_getParameter() invalid pValueSize10 %d", *pValueSize);
1604                 return -EINVAL;
1605             }
1606             *pValueSize = sizeof(int16_t);
1607             break;
1608         case REVERB_PARAM_PROPERTIES:
1609             if (*pValueSize != sizeof(t_reverb_settings)){
1610                 LOGV("\tLVM_ERROR : Reverb_getParameter() invalid pValueSize11 %d", *pValueSize);
1611                 return -EINVAL;
1612             }
1613             *pValueSize = sizeof(t_reverb_settings);
1614             break;
1615 
1616         default:
1617             LOGV("\tLVM_ERROR : Reverb_getParameter() invalid param %d", param);
1618             return -EINVAL;
1619     }
1620 
1621     pProperties = (t_reverb_settings *) pValue;
1622 
1623     switch (param){
1624         case REVERB_PARAM_PROPERTIES:
1625             pProperties->roomLevel = ReverbGetRoomLevel(pContext);
1626             pProperties->roomHFLevel = ReverbGetRoomHfLevel(pContext);
1627             pProperties->decayTime = ReverbGetDecayTime(pContext);
1628             pProperties->decayHFRatio = ReverbGetDecayHfRatio(pContext);
1629             pProperties->reflectionsLevel = 0;
1630             pProperties->reflectionsDelay = 0;
1631             pProperties->reverbDelay = 0;
1632             pProperties->reverbLevel = ReverbGetReverbLevel(pContext);
1633             pProperties->diffusion = ReverbGetDiffusion(pContext);
1634             pProperties->density = ReverbGetDensity(pContext);
1635 
1636             LOGV("\tReverb_getParameter() REVERB_PARAM_PROPERTIES Value is roomLevel        %d",
1637                 pProperties->roomLevel);
1638             LOGV("\tReverb_getParameter() REVERB_PARAM_PROPERTIES Value is roomHFLevel      %d",
1639                 pProperties->roomHFLevel);
1640             LOGV("\tReverb_getParameter() REVERB_PARAM_PROPERTIES Value is decayTime        %d",
1641                 pProperties->decayTime);
1642             LOGV("\tReverb_getParameter() REVERB_PARAM_PROPERTIES Value is decayHFRatio     %d",
1643                 pProperties->decayHFRatio);
1644             LOGV("\tReverb_getParameter() REVERB_PARAM_PROPERTIES Value is reflectionsLevel %d",
1645                 pProperties->reflectionsLevel);
1646             LOGV("\tReverb_getParameter() REVERB_PARAM_PROPERTIES Value is reflectionsDelay %d",
1647                 pProperties->reflectionsDelay);
1648             LOGV("\tReverb_getParameter() REVERB_PARAM_PROPERTIES Value is reverbDelay      %d",
1649                 pProperties->reverbDelay);
1650             LOGV("\tReverb_getParameter() REVERB_PARAM_PROPERTIES Value is reverbLevel      %d",
1651                 pProperties->reverbLevel);
1652             LOGV("\tReverb_getParameter() REVERB_PARAM_PROPERTIES Value is diffusion        %d",
1653                 pProperties->diffusion);
1654             LOGV("\tReverb_getParameter() REVERB_PARAM_PROPERTIES Value is density          %d",
1655                 pProperties->density);
1656             break;
1657 
1658         case REVERB_PARAM_ROOM_LEVEL:
1659             *(int16_t *)pValue = ReverbGetRoomLevel(pContext);
1660 
1661             //LOGV("\tReverb_getParameter() REVERB_PARAM_ROOM_LEVEL Value is %d",
1662             //        *(int16_t *)pValue);
1663             break;
1664         case REVERB_PARAM_ROOM_HF_LEVEL:
1665             *(int16_t *)pValue = ReverbGetRoomHfLevel(pContext);
1666 
1667             //LOGV("\tReverb_getParameter() REVERB_PARAM_ROOM_HF_LEVEL Value is %d",
1668             //        *(int16_t *)pValue);
1669             break;
1670         case REVERB_PARAM_DECAY_TIME:
1671             *(uint32_t *)pValue = ReverbGetDecayTime(pContext);
1672 
1673             //LOGV("\tReverb_getParameter() REVERB_PARAM_DECAY_TIME Value is %d",
1674             //        *(int32_t *)pValue);
1675             break;
1676         case REVERB_PARAM_DECAY_HF_RATIO:
1677             *(int16_t *)pValue = ReverbGetDecayHfRatio(pContext);
1678 
1679             //LOGV("\tReverb_getParameter() REVERB_PARAM_DECAY_HF_RATION Value is %d",
1680             //        *(int16_t *)pValue);
1681             break;
1682         case REVERB_PARAM_REVERB_LEVEL:
1683              *(int16_t *)pValue = ReverbGetReverbLevel(pContext);
1684 
1685             //LOGV("\tReverb_getParameter() REVERB_PARAM_REVERB_LEVEL Value is %d",
1686             //        *(int16_t *)pValue);
1687             break;
1688         case REVERB_PARAM_DIFFUSION:
1689             *(int16_t *)pValue = ReverbGetDiffusion(pContext);
1690 
1691             //LOGV("\tReverb_getParameter() REVERB_PARAM_DECAY_DIFFUSION Value is %d",
1692             //        *(int16_t *)pValue);
1693             break;
1694         case REVERB_PARAM_DENSITY:
1695             *(uint16_t *)pValue = 0;
1696             *(int16_t *)pValue = ReverbGetDensity(pContext);
1697             //LOGV("\tReverb_getParameter() REVERB_PARAM_DENSITY Value is %d",
1698             //        *(uint32_t *)pValue);
1699             break;
1700         case REVERB_PARAM_REFLECTIONS_LEVEL:
1701             *(uint16_t *)pValue = 0;
1702         case REVERB_PARAM_REFLECTIONS_DELAY:
1703             *(uint32_t *)pValue = 0;
1704         case REVERB_PARAM_REVERB_DELAY:
1705             *(uint32_t *)pValue = 0;
1706             break;
1707 
1708         default:
1709             LOGV("\tLVM_ERROR : Reverb_getParameter() invalid param %d", param);
1710             status = -EINVAL;
1711             break;
1712     }
1713 
1714     //LOGV("\tReverb_getParameter end");
1715     return status;
1716 } /* end Reverb_getParameter */
1717 
1718 //----------------------------------------------------------------------------
1719 // Reverb_setParameter()
1720 //----------------------------------------------------------------------------
1721 // Purpose:
1722 // Set a Reverb parameter
1723 //
1724 // Inputs:
1725 //  pContext         - handle to instance data
1726 //  pParam           - pointer to parameter
1727 //  pValue           - pointer to value
1728 //
1729 // Outputs:
1730 //
1731 //----------------------------------------------------------------------------
1732 
Reverb_setParameter(ReverbContext * pContext,void * pParam,void * pValue)1733 int Reverb_setParameter (ReverbContext *pContext, void *pParam, void *pValue){
1734     int status = 0;
1735     int16_t level;
1736     int16_t ratio;
1737     uint32_t time;
1738     t_reverb_settings *pProperties;
1739     int32_t *pParamTemp = (int32_t *)pParam;
1740     int32_t param = *pParamTemp++;
1741 
1742     //LOGV("\tReverb_setParameter start");
1743     if (pContext->preset) {
1744         if (param != REVERB_PARAM_PRESET) {
1745             return -EINVAL;
1746         }
1747 
1748         uint16_t preset = *(uint16_t *)pValue;
1749         LOGV("set REVERB_PARAM_PRESET, preset %d", preset);
1750         if (preset > REVERB_PRESET_LAST) {
1751             return -EINVAL;
1752         }
1753         pContext->nextPreset = preset;
1754         return 0;
1755     }
1756 
1757     switch (param){
1758         case REVERB_PARAM_PROPERTIES:
1759             LOGV("\tReverb_setParameter() REVERB_PARAM_PROPERTIES");
1760             pProperties = (t_reverb_settings *) pValue;
1761             ReverbSetRoomLevel(pContext, pProperties->roomLevel);
1762             ReverbSetRoomHfLevel(pContext, pProperties->roomHFLevel);
1763             ReverbSetDecayTime(pContext, pProperties->decayTime);
1764             ReverbSetDecayHfRatio(pContext, pProperties->decayHFRatio);
1765             ReverbSetReverbLevel(pContext, pProperties->reverbLevel);
1766             ReverbSetDiffusion(pContext, pProperties->diffusion);
1767             ReverbSetDensity(pContext, pProperties->density);
1768             break;
1769         case REVERB_PARAM_ROOM_LEVEL:
1770             level = *(int16_t *)pValue;
1771             //LOGV("\tReverb_setParameter() REVERB_PARAM_ROOM_LEVEL value is %d", level);
1772             //LOGV("\tReverb_setParameter() Calling ReverbSetRoomLevel");
1773             ReverbSetRoomLevel(pContext, level);
1774             //LOGV("\tReverb_setParameter() Called ReverbSetRoomLevel");
1775            break;
1776         case REVERB_PARAM_ROOM_HF_LEVEL:
1777             level = *(int16_t *)pValue;
1778             //LOGV("\tReverb_setParameter() REVERB_PARAM_ROOM_HF_LEVEL value is %d", level);
1779             //LOGV("\tReverb_setParameter() Calling ReverbSetRoomHfLevel");
1780             ReverbSetRoomHfLevel(pContext, level);
1781             //LOGV("\tReverb_setParameter() Called ReverbSetRoomHfLevel");
1782            break;
1783         case REVERB_PARAM_DECAY_TIME:
1784             time = *(uint32_t *)pValue;
1785             //LOGV("\tReverb_setParameter() REVERB_PARAM_DECAY_TIME value is %d", time);
1786             //LOGV("\tReverb_setParameter() Calling ReverbSetDecayTime");
1787             ReverbSetDecayTime(pContext, time);
1788             //LOGV("\tReverb_setParameter() Called ReverbSetDecayTime");
1789            break;
1790         case REVERB_PARAM_DECAY_HF_RATIO:
1791             ratio = *(int16_t *)pValue;
1792             //LOGV("\tReverb_setParameter() REVERB_PARAM_DECAY_HF_RATIO value is %d", ratio);
1793             //LOGV("\tReverb_setParameter() Calling ReverbSetDecayHfRatio");
1794             ReverbSetDecayHfRatio(pContext, ratio);
1795             //LOGV("\tReverb_setParameter() Called ReverbSetDecayHfRatio");
1796             break;
1797          case REVERB_PARAM_REVERB_LEVEL:
1798             level = *(int16_t *)pValue;
1799             //LOGV("\tReverb_setParameter() REVERB_PARAM_REVERB_LEVEL value is %d", level);
1800             //LOGV("\tReverb_setParameter() Calling ReverbSetReverbLevel");
1801             ReverbSetReverbLevel(pContext, level);
1802             //LOGV("\tReverb_setParameter() Called ReverbSetReverbLevel");
1803            break;
1804         case REVERB_PARAM_DIFFUSION:
1805             ratio = *(int16_t *)pValue;
1806             //LOGV("\tReverb_setParameter() REVERB_PARAM_DECAY_DIFFUSION value is %d", ratio);
1807             //LOGV("\tReverb_setParameter() Calling ReverbSetDiffusion");
1808             ReverbSetDiffusion(pContext, ratio);
1809             //LOGV("\tReverb_setParameter() Called ReverbSetDiffusion");
1810             break;
1811         case REVERB_PARAM_DENSITY:
1812             ratio = *(int16_t *)pValue;
1813             //LOGV("\tReverb_setParameter() REVERB_PARAM_DECAY_DENSITY value is %d", ratio);
1814             //LOGV("\tReverb_setParameter() Calling ReverbSetDensity");
1815             ReverbSetDensity(pContext, ratio);
1816             //LOGV("\tReverb_setParameter() Called ReverbSetDensity");
1817             break;
1818            break;
1819         case REVERB_PARAM_REFLECTIONS_LEVEL:
1820         case REVERB_PARAM_REFLECTIONS_DELAY:
1821         case REVERB_PARAM_REVERB_DELAY:
1822             break;
1823         default:
1824             LOGV("\tLVM_ERROR : Reverb_setParameter() invalid param %d", param);
1825             break;
1826     }
1827 
1828     //LOGV("\tReverb_setParameter end");
1829     return status;
1830 } /* end Reverb_setParameter */
1831 
1832 } // namespace
1833 } // namespace
1834 
1835 /* Effect Control Interface Implementation: Process */
Reverb_process(effect_interface_t self,audio_buffer_t * inBuffer,audio_buffer_t * outBuffer)1836 extern "C" int Reverb_process(effect_interface_t   self,
1837                                  audio_buffer_t         *inBuffer,
1838                                  audio_buffer_t         *outBuffer){
1839     android::ReverbContext * pContext = (android::ReverbContext *) self;
1840     int    status = 0;
1841 
1842     if (pContext == NULL){
1843         LOGV("\tLVM_ERROR : Reverb_process() ERROR pContext == NULL");
1844         return -EINVAL;
1845     }
1846     if (inBuffer == NULL  || inBuffer->raw == NULL  ||
1847             outBuffer == NULL || outBuffer->raw == NULL ||
1848             inBuffer->frameCount != outBuffer->frameCount){
1849         LOGV("\tLVM_ERROR : Reverb_process() ERROR NULL INPUT POINTER OR FRAME COUNT IS WRONG");
1850         return -EINVAL;
1851     }
1852     //LOGV("\tReverb_process() Calling process with %d frames", outBuffer->frameCount);
1853     /* Process all the available frames, block processing is handled internalLY by the LVM bundle */
1854     status = process(    (LVM_INT16 *)inBuffer->raw,
1855                          (LVM_INT16 *)outBuffer->raw,
1856                                       outBuffer->frameCount,
1857                                       pContext);
1858 
1859     if (pContext->bEnabled == LVM_FALSE) {
1860         if (pContext->SamplesToExitCount > 0) {
1861             pContext->SamplesToExitCount -= outBuffer->frameCount;
1862         } else {
1863             status = -ENODATA;
1864         }
1865     }
1866 
1867     return status;
1868 }   /* end Reverb_process */
1869 
1870 /* Effect Control Interface Implementation: Command */
Reverb_command(effect_interface_t self,uint32_t cmdCode,uint32_t cmdSize,void * pCmdData,uint32_t * replySize,void * pReplyData)1871 extern "C" int Reverb_command(effect_interface_t  self,
1872                               uint32_t            cmdCode,
1873                               uint32_t            cmdSize,
1874                               void                *pCmdData,
1875                               uint32_t            *replySize,
1876                               void                *pReplyData){
1877     android::ReverbContext * pContext = (android::ReverbContext *) self;
1878     int retsize;
1879     LVREV_ControlParams_st    ActiveParams;              /* Current control Parameters */
1880     LVREV_ReturnStatus_en     LvmStatus=LVREV_SUCCESS;     /* Function call status */
1881 
1882 
1883     if (pContext == NULL){
1884         LOGV("\tLVM_ERROR : Reverb_command ERROR pContext == NULL");
1885         return -EINVAL;
1886     }
1887 
1888     //LOGV("\tReverb_command INPUTS are: command %d cmdSize %d",cmdCode, cmdSize);
1889 
1890     switch (cmdCode){
1891         case EFFECT_CMD_INIT:
1892             //LOGV("\tReverb_command cmdCode Case: "
1893             //        "EFFECT_CMD_INIT start");
1894 
1895             if (pReplyData == NULL || *replySize != sizeof(int)){
1896                 LOGV("\tLVM_ERROR : Reverb_command cmdCode Case: "
1897                         "EFFECT_CMD_INIT: ERROR");
1898                 return -EINVAL;
1899             }
1900             *(int *) pReplyData = 0;
1901             break;
1902 
1903         case EFFECT_CMD_CONFIGURE:
1904             //LOGV("\tReverb_command cmdCode Case: "
1905             //        "EFFECT_CMD_CONFIGURE start");
1906             if (pCmdData    == NULL||
1907                 cmdSize     != sizeof(effect_config_t)||
1908                 pReplyData  == NULL||
1909                 *replySize  != sizeof(int)){
1910                 LOGV("\tLVM_ERROR : Reverb_command cmdCode Case: "
1911                         "EFFECT_CMD_CONFIGURE: ERROR");
1912                 return -EINVAL;
1913             }
1914             *(int *) pReplyData = Reverb_configure(pContext, (effect_config_t *) pCmdData);
1915             break;
1916 
1917         case EFFECT_CMD_RESET:
1918             //LOGV("\tReverb_command cmdCode Case: "
1919             //        "EFFECT_CMD_RESET start");
1920             Reverb_configure(pContext, &pContext->config);
1921             break;
1922 
1923         case EFFECT_CMD_GET_PARAM:{
1924             //LOGV("\tReverb_command cmdCode Case: "
1925             //        "EFFECT_CMD_GET_PARAM start");
1926             if (pCmdData == NULL ||
1927                     cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t)) ||
1928                     pReplyData == NULL ||
1929                     *replySize < (int) (sizeof(effect_param_t) + sizeof(int32_t))){
1930                 LOGV("\tLVM_ERROR : Reverb_command cmdCode Case: "
1931                         "EFFECT_CMD_GET_PARAM: ERROR");
1932                 return -EINVAL;
1933             }
1934             effect_param_t *p = (effect_param_t *)pCmdData;
1935 
1936             memcpy(pReplyData, pCmdData, sizeof(effect_param_t) + p->psize);
1937 
1938             p = (effect_param_t *)pReplyData;
1939 
1940             int voffset = ((p->psize - 1) / sizeof(int32_t) + 1) * sizeof(int32_t);
1941 
1942             p->status = android::Reverb_getParameter(pContext,
1943                                                          (void *)p->data,
1944                                                          (size_t  *)&p->vsize,
1945                                                           p->data + voffset);
1946 
1947             *replySize = sizeof(effect_param_t) + voffset + p->vsize;
1948 
1949             //LOGV("\tReverb_command EFFECT_CMD_GET_PARAM "
1950             //        "*pCmdData %d, *replySize %d, *pReplyData %d ",
1951             //        *(int32_t *)((char *)pCmdData + sizeof(effect_param_t)),
1952             //        *replySize,
1953             //        *(int16_t *)((char *)pReplyData + sizeof(effect_param_t) + voffset));
1954 
1955         } break;
1956         case EFFECT_CMD_SET_PARAM:{
1957 
1958             //LOGV("\tReverb_command cmdCode Case: "
1959             //        "EFFECT_CMD_SET_PARAM start");
1960             //LOGV("\tReverb_command EFFECT_CMD_SET_PARAM param %d, *replySize %d, value %d ",
1961             //        *(int32_t *)((char *)pCmdData + sizeof(effect_param_t)),
1962             //        *replySize,
1963             //        *(int16_t *)((char *)pCmdData + sizeof(effect_param_t) + sizeof(int32_t)));
1964 
1965             if (pCmdData == NULL || (cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t)))
1966                     || pReplyData == NULL || *replySize != (int)sizeof(int32_t)) {
1967                 LOGV("\tLVM_ERROR : Reverb_command cmdCode Case: "
1968                         "EFFECT_CMD_SET_PARAM: ERROR");
1969                 return -EINVAL;
1970             }
1971 
1972             effect_param_t *p = (effect_param_t *) pCmdData;
1973 
1974             if (p->psize != sizeof(int32_t)){
1975                 LOGV("\t4LVM_ERROR : Reverb_command cmdCode Case: "
1976                         "EFFECT_CMD_SET_PARAM: ERROR, psize is not sizeof(int32_t)");
1977                 return -EINVAL;
1978             }
1979 
1980             //LOGV("\tn5Reverb_command cmdSize is %d\n"
1981             //        "\tsizeof(effect_param_t) is  %d\n"
1982             //        "\tp->psize is %d\n"
1983             //        "\tp->vsize is %d"
1984             //        "\n",
1985             //        cmdSize, sizeof(effect_param_t), p->psize, p->vsize );
1986 
1987             *(int *)pReplyData = android::Reverb_setParameter(pContext,
1988                                                              (void *)p->data,
1989                                                               p->data + p->psize);
1990         } break;
1991 
1992         case EFFECT_CMD_ENABLE:
1993             //LOGV("\tReverb_command cmdCode Case: "
1994             //        "EFFECT_CMD_ENABLE start");
1995 
1996             if (pReplyData == NULL || *replySize != sizeof(int)){
1997                 LOGV("\tLVM_ERROR : Reverb_command cmdCode Case: "
1998                         "EFFECT_CMD_ENABLE: ERROR");
1999                 return -EINVAL;
2000             }
2001             if(pContext->bEnabled == LVM_TRUE){
2002                  LOGV("\tLVM_ERROR : Reverb_command cmdCode Case: "
2003                          "EFFECT_CMD_ENABLE: ERROR-Effect is already enabled");
2004                  return -EINVAL;
2005              }
2006             *(int *)pReplyData = 0;
2007             pContext->bEnabled = LVM_TRUE;
2008             /* Get the current settings */
2009             LvmStatus = LVREV_GetControlParameters(pContext->hInstance, &ActiveParams);
2010             LVM_ERROR_CHECK(LvmStatus, "LVREV_GetControlParameters", "EFFECT_CMD_ENABLE")
2011             pContext->SamplesToExitCount =
2012                     (ActiveParams.T60 * pContext->config.inputCfg.samplingRate)/1000;
2013             // force no volume ramp for first buffer processed after enabling the effect
2014             pContext->volumeMode = android::REVERB_VOLUME_FLAT;
2015             //LOGV("\tEFFECT_CMD_ENABLE SamplesToExitCount = %d", pContext->SamplesToExitCount);
2016             break;
2017         case EFFECT_CMD_DISABLE:
2018             //LOGV("\tReverb_command cmdCode Case: "
2019             //        "EFFECT_CMD_DISABLE start");
2020 
2021             if (pReplyData == NULL || *replySize != sizeof(int)){
2022                 LOGV("\tLVM_ERROR : Reverb_command cmdCode Case: "
2023                         "EFFECT_CMD_DISABLE: ERROR");
2024                 return -EINVAL;
2025             }
2026             if(pContext->bEnabled == LVM_FALSE){
2027                  LOGV("\tLVM_ERROR : Reverb_command cmdCode Case: "
2028                          "EFFECT_CMD_DISABLE: ERROR-Effect is not yet enabled");
2029                  return -EINVAL;
2030              }
2031             *(int *)pReplyData = 0;
2032             pContext->bEnabled = LVM_FALSE;
2033             break;
2034 
2035         case EFFECT_CMD_SET_VOLUME:
2036             if (pCmdData == NULL ||
2037                 cmdSize != 2 * sizeof(uint32_t)) {
2038                 LOGV("\tLVM_ERROR : Reverb_command cmdCode Case: "
2039                         "EFFECT_CMD_SET_VOLUME: ERROR");
2040                 return -EINVAL;
2041             }
2042 
2043 
2044             if (pReplyData != NULL) { // we have volume control
2045                 pContext->leftVolume = (LVM_INT16)((*(uint32_t *)pCmdData + (1 << 11)) >> 12);
2046                 pContext->rightVolume = (LVM_INT16)((*((uint32_t *)pCmdData + 1) + (1 << 11)) >> 12);
2047                 *(uint32_t *)pReplyData = (1 << 24);
2048                 *((uint32_t *)pReplyData + 1) = (1 << 24);
2049                 if (pContext->volumeMode == android::REVERB_VOLUME_OFF) {
2050                     // force no volume ramp for first buffer processed after getting volume control
2051                     pContext->volumeMode = android::REVERB_VOLUME_FLAT;
2052                 }
2053             } else { // we don't have volume control
2054                 pContext->leftVolume = REVERB_UNIT_VOLUME;
2055                 pContext->rightVolume = REVERB_UNIT_VOLUME;
2056                 pContext->volumeMode = android::REVERB_VOLUME_OFF;
2057             }
2058             LOGV("EFFECT_CMD_SET_VOLUME left %d, right %d mode %d",
2059                     pContext->leftVolume, pContext->rightVolume,  pContext->volumeMode);
2060             break;
2061 
2062         case EFFECT_CMD_SET_DEVICE:
2063         case EFFECT_CMD_SET_AUDIO_MODE:
2064         //LOGV("\tReverb_command cmdCode Case: "
2065         //        "EFFECT_CMD_SET_DEVICE/EFFECT_CMD_SET_VOLUME/EFFECT_CMD_SET_AUDIO_MODE start");
2066             break;
2067 
2068         default:
2069             LOGV("\tLVM_ERROR : Reverb_command cmdCode Case: "
2070                     "DEFAULT start %d ERROR",cmdCode);
2071             return -EINVAL;
2072     }
2073 
2074     //LOGV("\tReverb_command end\n\n");
2075     return 0;
2076 }    /* end Reverb_command */
2077 
2078 // effect_interface_t interface implementation for Reverb effect
2079 const struct effect_interface_s gReverbInterface = {
2080     Reverb_process,
2081     Reverb_command
2082 };    /* end gReverbInterface */
2083 
2084