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 /**********************************************************************************
26 FUNCTION ADD2_SAT_32X32
27 ***********************************************************************************/
28
Add2_Sat_32x32(const LVM_INT32 * src,LVM_INT32 * dst,LVM_INT16 n)29 void Add2_Sat_32x32( const LVM_INT32 *src,
30 LVM_INT32 *dst,
31 LVM_INT16 n )
32 {
33 LVM_INT32 a,b,c;
34 LVM_INT16 ii;
35 for (ii = n; ii != 0; ii--)
36 {
37 a=*src;
38 src++;
39
40 b=*dst;
41 c=a+b;
42 if ((((c ^ a) & (c ^ b)) >> 31)!=0) /* overflow / underflow */
43 {
44 if(a<0)
45 {
46 c=0x80000000l;
47 }
48 else
49 {
50 c=0x7FFFFFFFl;
51 }
52 }
53
54 *dst = c;
55 dst++;
56 }
57 return;
58 }
59
60 #ifdef BUILD_FLOAT
Add2_Sat_Float(const LVM_FLOAT * src,LVM_FLOAT * dst,LVM_INT16 n)61 void Add2_Sat_Float( const LVM_FLOAT *src,
62 LVM_FLOAT *dst,
63 LVM_INT16 n )
64 {
65 LVM_FLOAT Temp;
66 LVM_INT16 ii;
67 for (ii = n; ii != 0; ii--)
68 {
69 Temp = ((LVM_FLOAT) *src) + ((LVM_FLOAT) *dst);
70 src++;
71
72 if (Temp > 1.000000f)
73 {
74 *dst = 1.000000f;
75 }
76 else if (Temp < -1.000000f)
77 {
78 *dst = -1.000000f;
79 }
80 else
81 {
82 *dst = Temp;
83 }
84 dst++;
85 }
86 return;
87 }
88 #endif
89 /**********************************************************************************/
90