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 #include "LVM_Macros.h" 24 25 /********************************************************************************** 26 FUNCTION MAC3S_16X16 27 ***********************************************************************************/ 28 29 void Mac3s_Sat_32x16( const LVM_INT32 *src, 30 const LVM_INT16 val, 31 LVM_INT32 *dst, 32 LVM_INT16 n) 33 { 34 LVM_INT16 ii; 35 LVM_INT32 srcval,temp, dInVal, dOutVal; 36 37 38 for (ii = n; ii != 0; ii--) 39 { 40 srcval=*src; 41 src++; 42 43 MUL32x16INTO32(srcval,val,temp,15) 44 45 dInVal = *dst; 46 dOutVal = temp + dInVal; 47 48 49 if ((((dOutVal ^ temp) & (dOutVal ^ dInVal)) >> 31)!=0) /* overflow / underflow */ 50 { 51 if(temp<0) 52 { 53 dOutVal=0x80000000l; 54 } 55 else 56 { 57 dOutVal=0x7FFFFFFFl; 58 } 59 } 60 61 *dst = dOutVal; 62 dst++; 63 } 64 65 return; 66 } 67 68 /**********************************************************************************/ 69 70 71 72