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 Shift_Sat_v32xv32
26 ***********************************************************************************/
27 #ifdef BUILD_FLOAT
Shift_Sat_Float(const LVM_INT16 val,const LVM_FLOAT * src,LVM_FLOAT * dst,LVM_INT16 n)28 void Shift_Sat_Float (const LVM_INT16 val,
29 const LVM_FLOAT *src,
30 LVM_FLOAT *dst,
31 LVM_INT16 n)
32 {
33 LVM_FLOAT temp;
34 LVM_INT32 ii,ij;
35 LVM_INT16 RShift;
36
37 if(val > 0)
38 {
39 for (ii = n; ii != 0; ii--)
40 {
41 temp = (LVM_FLOAT)*src;
42 src++;
43 for(ij = 0; ij < val; ij++)
44 {
45 temp = temp * 2;
46 }
47
48 if(temp > 1.0)
49 temp = 1.0;
50 if(temp < -1.0)
51 temp = -1.0;
52
53 *dst = (LVM_FLOAT)temp;
54 dst++;
55 }
56 }
57 else if(val < 0)
58 {
59 RShift=(LVM_INT16)(-val);
60
61 for (ii = n; ii != 0; ii--)
62 {
63 temp = (LVM_FLOAT)*src;
64 src++;
65 for(ij = 0; ij < RShift; ij++)
66 {
67 temp = temp / 2;
68 }
69 *dst = (LVM_FLOAT)temp;
70 dst++;
71 }
72 }
73 else
74 {
75 if(src != dst)
76 {
77 Copy_Float(src, dst, n);
78 }
79 }
80 return;
81 }
82 #else
Shift_Sat_v32xv32(const LVM_INT16 val,const LVM_INT32 * src,LVM_INT32 * dst,LVM_INT16 n)83 void Shift_Sat_v32xv32 (const LVM_INT16 val,
84 const LVM_INT32 *src,
85 LVM_INT32 *dst,
86 LVM_INT16 n)
87 {
88 LVM_INT32 ii;
89 LVM_INT16 RShift;
90
91 if(val>0)
92 {
93 LVM_INT32 a,b;
94
95 for (ii = n; ii != 0; ii--)
96 {
97 a=*src;
98 src++;
99
100 b=(a<<val);
101
102 if( (b>>val) != a ) /* if overflow occured, right shift will show difference*/
103 {
104 if(a<0)
105 {
106 b=0x80000000l;
107 }
108 else
109 {
110 b=0x7FFFFFFFl;
111 }
112 }
113
114 *dst = b;
115 dst++;
116 }
117 }
118 else if(val<0)
119 {
120 RShift=(LVM_INT16)(-val);
121 for (ii = n; ii != 0; ii--)
122 {
123 *dst = (*src >> RShift);
124 dst++;
125 src++;
126 }
127 }
128 else
129 {
130 if(src!=dst)
131 {
132 Copy_16((LVM_INT16 *)src,(LVM_INT16 *)dst,(LVM_INT16)(n<<1));
133 }
134 }
135 return;
136 }
137 #endif
138 /**********************************************************************************/
139