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
Mac3s_Sat_32x16(const LVM_INT32 * src,const LVM_INT16 val,LVM_INT32 * dst,LVM_INT16 n)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 #ifdef BUILD_FLOAT
Mac3s_Sat_Float(const LVM_FLOAT * src,const LVM_FLOAT val,LVM_FLOAT * dst,LVM_INT16 n)68 void Mac3s_Sat_Float(const LVM_FLOAT *src,
69 const LVM_FLOAT val,
70 LVM_FLOAT *dst,
71 LVM_INT16 n)
72 {
73 LVM_INT16 ii;
74 LVM_FLOAT srcval;
75 LVM_FLOAT Temp,dInVal;
76
77 for (ii = n; ii != 0; ii--)
78 {
79 srcval = *src;
80 src++;
81
82 Temp = srcval * val;
83
84 dInVal = (LVM_FLOAT)*dst;
85 Temp = Temp + dInVal;
86
87 if (Temp > 1.000000f)
88 {
89 *dst = 1.000000f;
90 }
91 else if (Temp < -1.000000f)
92 {
93 *dst = -1.000000f;
94 }
95 else
96 {
97 *dst = Temp;
98 }
99 dst++;
100 }
101
102 return;
103 }
104 #endif
105 /**********************************************************************************/
106
107
108
109