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 /**********************************************************************************/
81