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 "VectorArithmetic.h" 23 24 /********************************************************************************** 25 FUNCTION MSTO2I_SAT_16X16 26 ***********************************************************************************/ 27 28 void MSTo2i_Sat_16x16(const LVM_INT16 *srcM, 29 const LVM_INT16 *srcS, 30 LVM_INT16 *dst, 31 LVM_INT16 n ) 32 { 33 LVM_INT32 temp,mVal,sVal; 34 LVM_INT16 ii; 35 36 37 for (ii = n; ii != 0; ii--) 38 { 39 mVal=(LVM_INT32)*srcM; 40 srcM++; 41 42 sVal=(LVM_INT32)*srcS; 43 srcS++; 44 45 temp = mVal + sVal; 46 47 if (temp > 0x00007FFF) 48 { 49 *dst = 0x7FFF; 50 } 51 else if (temp < -0x00008000) 52 { 53 *dst = - 0x8000; 54 } 55 else 56 { 57 *dst = (LVM_INT16)temp; 58 } 59 dst++; 60 61 temp = mVal - sVal; 62 63 if (temp > 0x00007FFF) 64 { 65 *dst = 0x7FFF; 66 } 67 else if (temp < -0x00008000) 68 { 69 *dst = - 0x8000; 70 } 71 else 72 { 73 *dst = (LVM_INT16)temp; 74 } 75 dst++; 76 } 77 78 return; 79 } 80 #ifdef BUILD_FLOAT 81 void MSTo2i_Sat_Float(const LVM_FLOAT *srcM, 82 const LVM_FLOAT *srcS, 83 LVM_FLOAT *dst, 84 LVM_INT16 n ) 85 { 86 LVM_FLOAT temp,mVal,sVal; 87 LVM_INT16 ii; 88 89 90 for (ii = n; ii != 0; ii--) 91 { 92 mVal = (LVM_FLOAT)*srcM; 93 srcM++; 94 95 sVal = (LVM_FLOAT)*srcS; 96 srcS++; 97 98 temp = mVal + sVal; 99 100 if (temp > 1.0f) 101 { 102 *dst = 1.0f; 103 } 104 else if (temp < -1.0f) 105 { 106 *dst = -1.0f; 107 } 108 else 109 { 110 *dst = (LVM_FLOAT)temp; 111 } 112 dst++; 113 114 temp = mVal - sVal; 115 116 if (temp > 1.0f) 117 { 118 *dst = 1.0f; 119 } 120 else if (temp < -1.0f) 121 { 122 *dst = - 1.0f; 123 } 124 else 125 { 126 *dst = (LVM_FLOAT)temp; 127 } 128 dst++; 129 } 130 131 return; 132 } 133 #endif 134 /**********************************************************************************/ 135
