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
MSTo2i_Sat_16x16(const LVM_INT16 * srcM,const LVM_INT16 * srcS,LVM_INT16 * dst,LVM_INT16 n)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
MSTo2i_Sat_Float(const LVM_FLOAT * srcM,const LVM_FLOAT * srcS,LVM_FLOAT * dst,LVM_INT16 n)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