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 24 /********************************************************************************** 25 FUNCTION LVCore_MIXHARD_2ST_D16C31_SAT 26 ***********************************************************************************/ 27 #ifdef BUILD_FLOAT 28 void LVC_Core_MixHard_2St_D16C31_SAT( LVMixer3_FLOAT_st *ptrInstance1, 29 LVMixer3_FLOAT_st *ptrInstance2, 30 const LVM_FLOAT *src1, 31 const LVM_FLOAT *src2, 32 LVM_FLOAT *dst, 33 LVM_INT16 n) 34 { 35 LVM_FLOAT Temp; 36 LVM_INT16 ii; 37 LVM_FLOAT Current1; 38 LVM_FLOAT Current2; 39 Mix_Private_FLOAT_st *pInstance1 = (Mix_Private_FLOAT_st *)(ptrInstance1->PrivateParams); 40 Mix_Private_FLOAT_st *pInstance2 = (Mix_Private_FLOAT_st *)(ptrInstance2->PrivateParams); 41 42 43 Current1 = (pInstance1->Current); 44 Current2 = (pInstance2->Current); 45 46 for (ii = n; ii != 0; ii--){ 47 Temp = (((LVM_FLOAT)*(src1++) * (LVM_FLOAT)Current1)) + 48 (((LVM_FLOAT)*(src2++) * (LVM_FLOAT)Current2)); 49 if (Temp > 1.0f) 50 *dst++ = 1.0f; 51 else if (Temp < -1.0f) 52 *dst++ = -1.0f; 53 else 54 *dst++ = Temp; 55 } 56 } 57 #else 58 void LVC_Core_MixHard_2St_D16C31_SAT( LVMixer3_st *ptrInstance1, 59 LVMixer3_st *ptrInstance2, 60 const LVM_INT16 *src1, 61 const LVM_INT16 *src2, 62 LVM_INT16 *dst, 63 LVM_INT16 n) 64 { 65 LVM_INT32 Temp; 66 LVM_INT16 ii; 67 LVM_INT16 Current1Short; 68 LVM_INT16 Current2Short; 69 Mix_Private_st *pInstance1=(Mix_Private_st *)(ptrInstance1->PrivateParams); 70 Mix_Private_st *pInstance2=(Mix_Private_st *)(ptrInstance2->PrivateParams); 71 72 73 Current1Short = (LVM_INT16)(pInstance1->Current >> 16); 74 Current2Short = (LVM_INT16)(pInstance2->Current >> 16); 75 76 for (ii = n; ii != 0; ii--){ 77 Temp = (((LVM_INT32)*(src1++) * (LVM_INT32)Current1Short)>>15) + 78 (((LVM_INT32)*(src2++) * (LVM_INT32)Current2Short)>>15); 79 if (Temp > 0x00007FFF) 80 *dst++ = 0x7FFF; 81 else if (Temp < -0x00008000) 82 *dst++ = - 0x8000; 83 else 84 *dst++ = (LVM_INT16)Temp; 85 } 86 } 87 #endif 88 /**********************************************************************************/ 89