Home | History | Annotate | Download | only in src 
      1 /*
      2  * Copyright (C) 2004-2010 NXP Software
      3  * Copyright (C) 2010 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 #include    "LVPSA.h"
     19 #include    "LVPSA_Private.h"
     20 #include    "InstAlloc.h"
     21 
     22 /************************************************************************************/
     23 /*                                                                                  */
     24 /* FUNCTION:            LVPSA_Init                                                  */
     25 /*                                                                                  */
     26 /* DESCRIPTION:                                                                     */
     27 /*  Initialize the LVPSA module                                                     */
     28 /*                                                                                  */
     29 /*                                                                                  */
     30 /* PARAMETERS:                                                                      */
     31 /*  phInstance          Pointer to pointer to the instance                          */
     32 /*  InitParams          Init parameters structure                                   */
     33 /*  ControlParams       Control parameters structure                                */
     34 /*  pMemoryTable        Memory table that contains memory areas definition          */
     35 /*                                                                                  */
     36 /*                                                                                  */
     37 /* RETURNS:                                                                         */
     38 /*  LVPSA_OK            Succeeds                                                    */
     39 /*  otherwise           Error due to bad parameters                                 */
     40 /*                                                                                  */
     41 /************************************************************************************/
     42 LVPSA_RETURN LVPSA_Init              ( pLVPSA_Handle_t             *phInstance,
     43                                        LVPSA_InitParams_t          *pInitParams,
     44                                        LVPSA_ControlParams_t       *pControlParams,
     45                                        LVPSA_MemTab_t              *pMemoryTable )
     46 {
     47     LVPSA_InstancePr_t          *pLVPSA_Inst;
     48     LVPSA_RETURN                errorCode       = LVPSA_OK;
     49     LVM_UINT32                  ii;
     50     extern LVM_INT16            LVPSA_GainTable[];
     51     LVM_UINT32                  BufferLength = 0;
     52 
     53     /* Ints_Alloc instances, needed for memory alignment management */
     54     INST_ALLOC          Instance;
     55     INST_ALLOC          Scratch;
     56     INST_ALLOC          Data;
     57     INST_ALLOC          Coef;
     58 
     59     /* Check parameters */
     60     if((phInstance == LVM_NULL) || (pInitParams == LVM_NULL) || (pControlParams == LVM_NULL) || (pMemoryTable == LVM_NULL))
     61     {
     62         return(LVPSA_ERROR_NULLADDRESS);
     63     }
     64     if( (pInitParams->SpectralDataBufferDuration > LVPSA_MAXBUFFERDURATION)   ||
     65         (pInitParams->SpectralDataBufferDuration == 0)                        ||
     66         (pInitParams->MaxInputBlockSize > LVPSA_MAXINPUTBLOCKSIZE)      ||
     67         (pInitParams->MaxInputBlockSize == 0)                           ||
     68         (pInitParams->nBands < LVPSA_NBANDSMIN)                         ||
     69         (pInitParams->nBands > LVPSA_NBANDSMAX)                         ||
     70         (pInitParams->pFiltersParams == 0))
     71     {
     72         return(LVPSA_ERROR_INVALIDPARAM);
     73     }
     74     for(ii = 0; ii < pInitParams->nBands; ii++)
     75     {
     76         if((pInitParams->pFiltersParams[ii].CenterFrequency > LVPSA_MAXCENTERFREQ) ||
     77            (pInitParams->pFiltersParams[ii].PostGain        > LVPSA_MAXPOSTGAIN)   ||
     78            (pInitParams->pFiltersParams[ii].PostGain        < LVPSA_MINPOSTGAIN)   ||
     79            (pInitParams->pFiltersParams[ii].QFactor < LVPSA_MINQFACTOR)            ||
     80            (pInitParams->pFiltersParams[ii].QFactor > LVPSA_MAXQFACTOR))
     81            {
     82                 return(LVPSA_ERROR_INVALIDPARAM);
     83            }
     84     }
     85 
     86 
     87     /*Inst_Alloc instances initialization */
     88     InstAlloc_Init( &Instance   , pMemoryTable->Region[LVPSA_MEMREGION_INSTANCE].pBaseAddress);
     89     InstAlloc_Init( &Scratch    , pMemoryTable->Region[LVPSA_MEMREGION_SCRATCH].pBaseAddress);
     90     InstAlloc_Init( &Data       , pMemoryTable->Region[LVPSA_MEMREGION_PERSISTENT_DATA].pBaseAddress);
     91     InstAlloc_Init( &Coef       , pMemoryTable->Region[LVPSA_MEMREGION_PERSISTENT_COEF].pBaseAddress);
     92 
     93 
     94     /* Set the instance handle if not already initialised */
     95     if (*phInstance == LVM_NULL)
     96     {
     97         *phInstance = InstAlloc_AddMember( &Instance, sizeof(LVPSA_InstancePr_t) );
     98     }
     99     pLVPSA_Inst =(LVPSA_InstancePr_t*)*phInstance;
    100 
    101 
    102     /* Check the memory table for NULL pointers */
    103     for (ii = 0; ii < LVPSA_NR_MEMORY_REGIONS; ii++)
    104     {
    105         if (pMemoryTable->Region[ii].Size!=0)
    106         {
    107             if (pMemoryTable->Region[ii].pBaseAddress==LVM_NULL)
    108             {
    109                 return(LVPSA_ERROR_NULLADDRESS);
    110             }
    111             pLVPSA_Inst->MemoryTable.Region[ii] = pMemoryTable->Region[ii];
    112         }
    113     }
    114 
    115     /* Initialize module's internal parameters */
    116     pLVPSA_Inst->bControlPending = LVM_FALSE;
    117     pLVPSA_Inst->nBands = pInitParams->nBands;
    118     pLVPSA_Inst->MaxInputBlockSize = pInitParams->MaxInputBlockSize;
    119     pLVPSA_Inst->SpectralDataBufferDuration = pInitParams->SpectralDataBufferDuration;
    120     pLVPSA_Inst->CurrentParams.Fs = LVM_FS_DUMMY;
    121     pLVPSA_Inst->CurrentParams.LevelDetectionSpeed = LVPSA_SPEED_DUMMY;
    122 
    123     {   /* for avoiding QAC warnings */
    124         LVM_INT32 SDBD=(LVM_INT32)pLVPSA_Inst->SpectralDataBufferDuration;
    125         LVM_INT32 IRTI=(LVM_INT32)LVPSA_InternalRefreshTimeInv;
    126         LVM_INT32 BL;
    127 
    128         MUL32x32INTO32(SDBD,IRTI,BL,LVPSA_InternalRefreshTimeShift)
    129 
    130         BufferLength=(LVM_UINT32)BL;
    131     }
    132 
    133     if((BufferLength * LVPSA_InternalRefreshTime) != pLVPSA_Inst->SpectralDataBufferDuration)
    134     {
    135         pLVPSA_Inst->SpectralDataBufferLength = BufferLength + 1;
    136     }
    137     else
    138     {
    139         pLVPSA_Inst->SpectralDataBufferLength = BufferLength;
    140     }
    141 
    142 
    143     /* Assign the pointers */
    144 
    145     pLVPSA_Inst->pPostGains                 = InstAlloc_AddMember( &Instance, pInitParams->nBands * sizeof(LVM_UINT16) );
    146     pLVPSA_Inst->pFiltersParams             = InstAlloc_AddMember( &Instance, pInitParams->nBands * sizeof(LVPSA_FilterParam_t) );
    147     pLVPSA_Inst->pSpectralDataBufferStart   = InstAlloc_AddMember( &Instance, pInitParams->nBands * pLVPSA_Inst->SpectralDataBufferLength * sizeof(LVM_UINT8) );
    148     pLVPSA_Inst->pPreviousPeaks             = InstAlloc_AddMember( &Instance, pInitParams->nBands * sizeof(LVM_UINT8) );
    149     pLVPSA_Inst->pBPFiltersPrecision        = InstAlloc_AddMember( &Instance, pInitParams->nBands * sizeof(LVPSA_BPFilterPrecision_en) );
    150 
    151     pLVPSA_Inst->pBP_Instances          = InstAlloc_AddMember( &Coef, pInitParams->nBands * sizeof(Biquad_Instance_t) );
    152     pLVPSA_Inst->pQPD_States            = InstAlloc_AddMember( &Coef, pInitParams->nBands * sizeof(QPD_State_t) );
    153 
    154     pLVPSA_Inst->pBP_Taps               = InstAlloc_AddMember( &Data, pInitParams->nBands * sizeof(Biquad_1I_Order2_Taps_t) );
    155     pLVPSA_Inst->pQPD_Taps              = InstAlloc_AddMember( &Data, pInitParams->nBands * sizeof(QPD_Taps_t) );
    156 
    157 
    158     /* Copy filters parameters in the private instance */
    159     for(ii = 0; ii < pLVPSA_Inst->nBands; ii++)
    160     {
    161         pLVPSA_Inst->pFiltersParams[ii] = pInitParams->pFiltersParams[ii];
    162     }
    163 
    164     /* Set Post filters gains*/
    165     for(ii = 0; ii < pLVPSA_Inst->nBands; ii++)
    166     {
    167         pLVPSA_Inst->pPostGains[ii] =(LVM_UINT16) LVPSA_GainTable[pInitParams->pFiltersParams[ii].PostGain + 15];
    168     }
    169     pLVPSA_Inst->pSpectralDataBufferWritePointer = pLVPSA_Inst->pSpectralDataBufferStart;
    170 
    171 
    172     /* Initialize control dependant internal parameters */
    173     errorCode = LVPSA_Control (*phInstance, pControlParams);
    174 
    175     if(errorCode!=0)
    176     {
    177         return errorCode;
    178     }
    179 
    180     errorCode = LVPSA_ApplyNewSettings (pLVPSA_Inst);
    181 
    182     if(errorCode!=0)
    183     {
    184         return errorCode;
    185     }
    186 
    187     return(errorCode);
    188 }
    189 
    190