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 "LVM_Macros.h" 24 #include "ScalarArithmetic.h" 25 26 27 /********************************************************************************** 28 FUNCTION LVC_Core_MixHard_1St_2i_D16C31_SAT 29 ***********************************************************************************/ 30 #ifdef BUILD_FLOAT 31 void LVC_Core_MixHard_1St_2i_D16C31_SAT( LVMixer3_FLOAT_st *ptrInstance1, 32 LVMixer3_FLOAT_st *ptrInstance2, 33 const LVM_FLOAT *src, 34 LVM_FLOAT *dst, 35 LVM_INT16 n) 36 { 37 LVM_FLOAT Temp; 38 LVM_INT16 ii; 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 for (ii = n; ii != 0; ii--) 42 { 43 Temp = ((LVM_FLOAT)*(src++) * (LVM_FLOAT)pInstance1->Current); 44 if (Temp > 1.0f) 45 *dst++ = 1.0f; 46 else if (Temp < -1.0f) 47 *dst++ = -1.0f; 48 else 49 *dst++ = (LVM_FLOAT)Temp; 50 51 Temp = ((LVM_FLOAT)*(src++) * (LVM_FLOAT)pInstance2->Current); 52 if (Temp > 1.0f) 53 *dst++ = 1.0f; 54 else if (Temp < -1.0f) 55 *dst++ = -1.0f; 56 else 57 *dst++ = (LVM_FLOAT)Temp; 58 } 59 60 61 } 62 #else 63 void LVC_Core_MixHard_1St_2i_D16C31_SAT( LVMixer3_st *ptrInstance1, 64 LVMixer3_st *ptrInstance2, 65 const LVM_INT16 *src, 66 LVM_INT16 *dst, 67 LVM_INT16 n) 68 { 69 LVM_INT32 Temp; 70 LVM_INT16 ii; 71 LVM_INT16 Current1Short; 72 LVM_INT16 Current2Short; 73 Mix_Private_st *pInstance1=(Mix_Private_st *)(ptrInstance1->PrivateParams); 74 Mix_Private_st *pInstance2=(Mix_Private_st *)(ptrInstance2->PrivateParams); 75 76 77 Current1Short = (LVM_INT16)(pInstance1->Current >> 16); 78 Current2Short = (LVM_INT16)(pInstance2->Current >> 16); 79 80 for (ii = n; ii != 0; ii--) 81 { 82 Temp = ((LVM_INT32)*(src++) * (LVM_INT32)Current1Short)>>15; 83 if (Temp > 0x00007FFF) 84 *dst++ = 0x7FFF; 85 else if (Temp < -0x00008000) 86 *dst++ = - 0x8000; 87 else 88 *dst++ = (LVM_INT16)Temp; 89 90 Temp = ((LVM_INT32)*(src++) * (LVM_INT32)Current2Short)>>15; 91 if (Temp > 0x00007FFF) 92 *dst++ = 0x7FFF; 93 else if (Temp < -0x00008000) 94 *dst++ = - 0x8000; 95 else 96 *dst++ = (LVM_INT16)Temp; 97 } 98 99 100 } 101 #endif 102 /**********************************************************************************/ 103