| /* |
| * Copyright (C) 2004-2010 NXP Software |
| * Copyright (C) 2010 The Android Open Source Project |
| * |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| */ |
| |
| /********************************************************************************** |
| INCLUDE FILES |
| ***********************************************************************************/ |
| |
| #include "LVC_Mixer_Private.h" |
| #include "VectorArithmetic.h" |
| #include "ScalarArithmetic.h" |
| |
| /********************************************************************************** |
| DEFINITIONS |
| ***********************************************************************************/ |
| |
| #define TRUE 1 |
| #define FALSE 0 |
| |
| /********************************************************************************** |
| FUNCTION MIXINSOFT_D16C31_SAT |
| ***********************************************************************************/ |
| #ifdef BUILD_FLOAT |
| void LVC_MixInSoft_D16C31_SAT(LVMixer3_1St_FLOAT_st *ptrInstance, |
| const LVM_FLOAT *src, |
| LVM_FLOAT *dst, |
| LVM_INT16 n) |
| { |
| char HardMixing = TRUE; |
| LVM_FLOAT TargetGain; |
| Mix_Private_FLOAT_st *pInstance = \ |
| (Mix_Private_FLOAT_st *)(ptrInstance->MixerStream[0].PrivateParams); |
| |
| if(n <= 0) return; |
| |
| /****************************************************************************** |
| SOFT MIXING |
| *******************************************************************************/ |
| if (pInstance->Current != pInstance->Target) |
| { |
| if(pInstance->Delta == 1.0f){ |
| pInstance->Current = pInstance->Target; |
| TargetGain = pInstance->Target; |
| LVC_Mixer_SetTarget(&(ptrInstance->MixerStream[0]), TargetGain); |
| }else if (Abs_Float(pInstance->Current - pInstance->Target) < pInstance->Delta){ |
| pInstance->Current = pInstance->Target; /* Difference is not significant anymore. \ |
| Make them equal. */ |
| TargetGain = pInstance->Target; |
| LVC_Mixer_SetTarget(&(ptrInstance->MixerStream[0]), TargetGain); |
| }else{ |
| /* Soft mixing has to be applied */ |
| HardMixing = FALSE; |
| LVC_Core_MixInSoft_D16C31_SAT(&(ptrInstance->MixerStream[0]), src, dst, n); |
| } |
| } |
| |
| /****************************************************************************** |
| HARD MIXING |
| *******************************************************************************/ |
| |
| if (HardMixing){ |
| if (pInstance->Target != 0){ /* Nothing to do in case Target = 0 */ |
| if ((pInstance->Target) == 1.0f){ |
| Add2_Sat_Float(src, dst, n); |
| } |
| else{ |
| Mac3s_Sat_Float(src, (pInstance->Target), dst, n); |
| /* In case the LVCore function would have changed the Current value */ |
| pInstance->Current = pInstance->Target; |
| } |
| } |
| } |
| |
| |
| /****************************************************************************** |
| CALL BACK |
| *******************************************************************************/ |
| |
| if (ptrInstance->MixerStream[0].CallbackSet){ |
| if (Abs_Float(pInstance->Current - pInstance->Target) < pInstance->Delta){ |
| pInstance->Current = pInstance->Target; /* Difference is not significant anymore. \ |
| Make them equal. */ |
| TargetGain = pInstance->Target; |
| LVC_Mixer_SetTarget(ptrInstance->MixerStream, TargetGain); |
| ptrInstance->MixerStream[0].CallbackSet = FALSE; |
| if (ptrInstance->MixerStream[0].pCallBack != 0){ |
| (*ptrInstance->MixerStream[0].pCallBack) ( \ |
| ptrInstance->MixerStream[0].pCallbackHandle, |
| ptrInstance->MixerStream[0].pGeneralPurpose, |
| ptrInstance->MixerStream[0].CallbackParam ); |
| } |
| } |
| } |
| |
| } |
| |
| |
| |
| #ifdef SUPPORT_MC |
| /* |
| * FUNCTION: LVC_MixInSoft_Mc_D16C31_SAT |
| * |
| * DESCRIPTION: |
| * Mixer function with support for processing multichannel input |
| * |
| * PARAMETERS: |
| * ptrInstance Instance pointer |
| * src Source |
| * dst Destination |
| * NrFrames Number of frames |
| * NrChannels Number of channels |
| * |
| * RETURNS: |
| * void |
| * |
| */ |
| void LVC_MixInSoft_Mc_D16C31_SAT(LVMixer3_1St_FLOAT_st *ptrInstance, |
| const LVM_FLOAT *src, |
| LVM_FLOAT *dst, |
| LVM_INT16 NrFrames, |
| LVM_INT16 NrChannels) |
| { |
| char HardMixing = TRUE; |
| LVM_FLOAT TargetGain; |
| Mix_Private_FLOAT_st *pInstance = \ |
| (Mix_Private_FLOAT_st *)(ptrInstance->MixerStream[0].PrivateParams); |
| |
| if (NrFrames <= 0) return; |
| |
| /****************************************************************************** |
| SOFT MIXING |
| *******************************************************************************/ |
| if (pInstance->Current != pInstance->Target) |
| { |
| if (pInstance->Delta == 1.0f) { |
| pInstance->Current = pInstance->Target; |
| TargetGain = pInstance->Target; |
| LVC_Mixer_SetTarget(&(ptrInstance->MixerStream[0]), TargetGain); |
| }else if (Abs_Float(pInstance->Current - pInstance->Target) < pInstance->Delta) { |
| pInstance->Current = pInstance->Target; /* Difference is not significant anymore. \ |
| Make them equal. */ |
| TargetGain = pInstance->Target; |
| LVC_Mixer_SetTarget(&(ptrInstance->MixerStream[0]), TargetGain); |
| }else{ |
| /* Soft mixing has to be applied */ |
| HardMixing = FALSE; |
| LVC_Core_MixInSoft_Mc_D16C31_SAT(&(ptrInstance->MixerStream[0]), |
| src, |
| dst, |
| NrFrames, |
| NrChannels); |
| } |
| } |
| |
| /****************************************************************************** |
| HARD MIXING |
| *******************************************************************************/ |
| |
| if (HardMixing) { |
| if (pInstance->Target != 0) { /* Nothing to do in case Target = 0 */ |
| if ((pInstance->Target) == 1.0f) { |
| Add2_Sat_Float(src, dst, NrFrames*NrChannels); |
| } |
| else{ |
| Mac3s_Sat_Float(src, |
| (pInstance->Target), |
| dst, |
| NrFrames * NrChannels); |
| /* In case the LVCore function would have changed the Current value */ |
| pInstance->Current = pInstance->Target; |
| } |
| } |
| } |
| |
| |
| /****************************************************************************** |
| CALL BACK |
| *******************************************************************************/ |
| |
| if (ptrInstance->MixerStream[0].CallbackSet) { |
| if (Abs_Float(pInstance->Current - pInstance->Target) < pInstance->Delta) { |
| pInstance->Current = pInstance->Target; /* Difference is not significant anymore. \ |
| Make them equal. */ |
| TargetGain = pInstance->Target; |
| LVC_Mixer_SetTarget(ptrInstance->MixerStream, TargetGain); |
| ptrInstance->MixerStream[0].CallbackSet = FALSE; |
| if (ptrInstance->MixerStream[0].pCallBack != 0) { |
| (*ptrInstance->MixerStream[0].pCallBack) (\ |
| ptrInstance->MixerStream[0].pCallbackHandle, |
| ptrInstance->MixerStream[0].pGeneralPurpose, |
| ptrInstance->MixerStream[0].CallbackParam); |
| } |
| } |
| } |
| |
| } |
| #endif |
| |
| |
| #else |
| void LVC_MixInSoft_D16C31_SAT( LVMixer3_1St_st *ptrInstance, |
| LVM_INT16 *src, |
| LVM_INT16 *dst, |
| LVM_INT16 n) |
| { |
| char HardMixing = TRUE; |
| LVM_INT32 TargetGain; |
| Mix_Private_st *pInstance=(Mix_Private_st *)(ptrInstance->MixerStream[0].PrivateParams); |
| |
| if(n<=0) return; |
| |
| /****************************************************************************** |
| SOFT MIXING |
| *******************************************************************************/ |
| if (pInstance->Current != pInstance->Target) |
| { |
| if(pInstance->Delta == 0x7FFFFFFF){ |
| pInstance->Current = pInstance->Target; |
| TargetGain=pInstance->Target>>(16-pInstance->Shift); // TargetGain in Q16.15 format |
| LVC_Mixer_SetTarget(&(ptrInstance->MixerStream[0]),TargetGain); |
| }else if (Abs_32(pInstance->Current-pInstance->Target) < pInstance->Delta){ |
| pInstance->Current = pInstance->Target; /* Difference is not significant anymore. Make them equal. */ |
| TargetGain=pInstance->Target>>(16-pInstance->Shift); // TargetGain in Q16.15 format |
| LVC_Mixer_SetTarget(&(ptrInstance->MixerStream[0]),TargetGain); |
| }else{ |
| /* Soft mixing has to be applied */ |
| HardMixing = FALSE; |
| if(pInstance->Shift!=0){ |
| Shift_Sat_v16xv16 ((LVM_INT16)pInstance->Shift,src,src,n); |
| LVC_Core_MixInSoft_D16C31_SAT( &(ptrInstance->MixerStream[0]), src, dst, n); |
| } |
| else |
| LVC_Core_MixInSoft_D16C31_SAT( &(ptrInstance->MixerStream[0]), src, dst, n); |
| } |
| } |
| |
| /****************************************************************************** |
| HARD MIXING |
| *******************************************************************************/ |
| |
| if (HardMixing){ |
| if (pInstance->Target != 0){ /* Nothing to do in case Target = 0 */ |
| if ((pInstance->Target>>16) == 0x7FFF){ |
| if(pInstance->Shift!=0) |
| Shift_Sat_v16xv16 ((LVM_INT16)pInstance->Shift,src,src,n); |
| Add2_Sat_16x16( src, dst, n ); |
| } |
| else{ |
| if(pInstance->Shift!=0) |
| Shift_Sat_v16xv16 ((LVM_INT16)pInstance->Shift,src,src,n); |
| Mac3s_Sat_16x16(src,(LVM_INT16)(pInstance->Target>>16),dst,n); |
| pInstance->Current = pInstance->Target; /* In case the LVCore function would have changed the Current value */ |
| } |
| } |
| } |
| |
| |
| /****************************************************************************** |
| CALL BACK |
| *******************************************************************************/ |
| |
| if (ptrInstance->MixerStream[0].CallbackSet){ |
| if (Abs_32(pInstance->Current-pInstance->Target) < pInstance->Delta){ |
| pInstance->Current = pInstance->Target; /* Difference is not significant anymore. Make them equal. */ |
| TargetGain=pInstance->Target>>(16-pInstance->Shift); // TargetGain in Q16.15 format |
| LVC_Mixer_SetTarget(ptrInstance->MixerStream,TargetGain); |
| ptrInstance->MixerStream[0].CallbackSet = FALSE; |
| if (ptrInstance->MixerStream[0].pCallBack != 0){ |
| (*ptrInstance->MixerStream[0].pCallBack) ( ptrInstance->MixerStream[0].pCallbackHandle, ptrInstance->MixerStream[0].pGeneralPurpose,ptrInstance->MixerStream[0].CallbackParam ); |
| } |
| } |
| } |
| |
| } |
| #endif |
| /**********************************************************************************/ |
