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
29void 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
68/**********************************************************************************/
69
70
71
72