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 for (ii = n; ii != 0; ii--)
38 {
39 srcval=*src;
40 src++;
41
42 MUL32x16INTO32(srcval,val,temp,15)
43
44 dInVal = *dst;
45 dOutVal = temp + dInVal;
46
47 if ((((dOutVal ^ temp) & (dOutVal ^ dInVal)) >> 31)!=0) /* overflow / underflow */
48 {
49 if(temp<0)
50 {
51 dOutVal=0x80000000L;
52 }
53 else
54 {
55 dOutVal=0x7FFFFFFFL;
56 }
57 }
58
59 *dst = dOutVal;
60 dst++;
61 }
62
63 return;
64 }
Mac3s_Sat_Float(const LVM_FLOAT * src,const LVM_FLOAT val,LVM_FLOAT * dst,LVM_INT16 n)65 void Mac3s_Sat_Float(const LVM_FLOAT *src,
66 const LVM_FLOAT val,
67 LVM_FLOAT *dst,
68 LVM_INT16 n)
69 {
70 LVM_INT16 ii;
71 LVM_FLOAT srcval;
72 LVM_FLOAT Temp,dInVal;
73
74 for (ii = n; ii != 0; ii--)
75 {
76 srcval = *src;
77 src++;
78
79 Temp = srcval * val;
80
81 dInVal = (LVM_FLOAT)*dst;
82 Temp = Temp + dInVal;
83
84 if (Temp > 1.000000f)
85 {
86 *dst = 1.000000f;
87 }
88 else if (Temp < -1.000000f)
89 {
90 *dst = -1.000000f;
91 }
92 else
93 {
94 *dst = Temp;
95 }
96 dst++;
97 }
98
99 return;
100 }
101 /**********************************************************************************/
102
103