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 /********************************************************************************** 19 INCLUDE FILES 20 ***********************************************************************************/ 21 22 #include "LVC_Mixer_Private.h" 23 #include "VectorArithmetic.h" 24 #include "ScalarArithmetic.h" 25 26 /********************************************************************************** 27 DEFINITIONS 28 ***********************************************************************************/ 29 30 #define TRUE 1 31 #define FALSE 0 32 33 /********************************************************************************** 34 FUNCTION LVMixer3_MIXSOFT_1ST_D16C31_SAT 35 ***********************************************************************************/ 36 37 void LVC_MixSoft_1St_D16C31_SAT( LVMixer3_1St_st *ptrInstance, 38 const LVM_INT16 *src, 39 LVM_INT16 *dst, 40 LVM_INT16 n) 41 { 42 char HardMixing = TRUE; 43 LVM_INT32 TargetGain; 44 Mix_Private_st *pInstance=(Mix_Private_st *)(ptrInstance->MixerStream[0].PrivateParams); 45 46 if(n<=0) return; 47 48 /****************************************************************************** 49 SOFT MIXING 50 *******************************************************************************/ 51 if (pInstance->Current != pInstance->Target) 52 { 53 if(pInstance->Delta == 0x7FFFFFFF){ 54 pInstance->Current = pInstance->Target; 55 TargetGain=pInstance->Target>>(16-pInstance->Shift); // TargetGain in Q16.15 format 56 LVC_Mixer_SetTarget(&(ptrInstance->MixerStream[0]),TargetGain); 57 }else if (Abs_32(pInstance->Current-pInstance->Target) < pInstance->Delta){ 58 pInstance->Current = pInstance->Target; /* Difference is not significant anymore. Make them equal. */ 59 TargetGain=pInstance->Target>>(16-pInstance->Shift); // TargetGain in Q16.15 format 60 LVC_Mixer_SetTarget(&(ptrInstance->MixerStream[0]),TargetGain); 61 }else{ 62 /* Soft mixing has to be applied */ 63 HardMixing = FALSE; 64 if(pInstance->Shift!=0){ 65 Shift_Sat_v16xv16 ((LVM_INT16)pInstance->Shift,src,dst,n); 66 LVC_Core_MixSoft_1St_D16C31_WRA( &(ptrInstance->MixerStream[0]), dst, dst, n); 67 } 68 else 69 LVC_Core_MixSoft_1St_D16C31_WRA( &(ptrInstance->MixerStream[0]), src, dst, n); 70 } 71 } 72 73 /****************************************************************************** 74 HARD MIXING 75 *******************************************************************************/ 76 77 if (HardMixing){ 78 if (pInstance->Target == 0) 79 LoadConst_16(0, dst, n); 80 else if(pInstance->Shift!=0){ 81 Shift_Sat_v16xv16 ((LVM_INT16)pInstance->Shift,src,dst,n); 82 if ((pInstance->Target>>16) != 0x7FFF) 83 Mult3s_16x16( dst, (LVM_INT16)(pInstance->Target>>16), dst, n ); 84 } 85 else { 86 if ((pInstance->Target>>16) != 0x7FFF) 87 Mult3s_16x16( src, (LVM_INT16)(pInstance->Target>>16), dst, n ); 88 else if(src!=dst) 89 Copy_16(src, dst, n); 90 } 91 92 } 93 94 /****************************************************************************** 95 CALL BACK 96 *******************************************************************************/ 97 98 if (ptrInstance->MixerStream[0].CallbackSet){ 99 if (Abs_32(pInstance->Current-pInstance->Target) < pInstance->Delta){ 100 pInstance->Current = pInstance->Target; /* Difference is not significant anymore. Make them equal. */ 101 TargetGain=pInstance->Target>>(16-pInstance->Shift); // TargetGain in Q16.15 format 102 LVC_Mixer_SetTarget(ptrInstance->MixerStream,TargetGain); 103 ptrInstance->MixerStream[0].CallbackSet = FALSE; 104 if (ptrInstance->MixerStream[0].pCallBack != 0){ 105 (*ptrInstance->MixerStream[0].pCallBack) ( ptrInstance->MixerStream[0].pCallbackHandle, ptrInstance->MixerStream[0].pGeneralPurpose,ptrInstance->MixerStream[0].CallbackParam ); 106 } 107 } 108 } 109 } 110 111 /**********************************************************************************/ 112
