Mac3s_Sat_32x16.c revision 2c8e5cab3faa6d360e222b7a6c40a80083d021ac
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/*                                                                      */
20/*     Project::                                                        */
21/*     $Author: beq07716 $*/
22/*     $Revision: 1000 $*/
23/*     $Date: 2010-06-28 13:08:20 +0200 (Mon, 28 Jun 2010) $*/
24/*                                                                      */
25/************************************************************************/
26
27/**********************************************************************************
28   INCLUDE FILES
29***********************************************************************************/
30
31#include "VectorArithmetic.h"
32#include "LVM_Macros.h"
33
34/**********************************************************************************
35   FUNCTION MAC3S_16X16
36***********************************************************************************/
37
38void Mac3s_Sat_32x16(  const LVM_INT32 *src,
39                     const LVM_INT16 val,
40                     LVM_INT32 *dst,
41                     LVM_INT16 n)
42{
43    LVM_INT16 ii;
44    LVM_INT32 srcval,temp, dInVal, dOutVal;
45
46
47    for (ii = n; ii != 0; ii--)
48    {
49        srcval=*src;
50        src++;
51
52        MUL32x16INTO32(srcval,val,temp,15)
53
54            dInVal  = *dst;
55        dOutVal = temp + dInVal;
56
57
58        if ((((dOutVal ^ temp) & (dOutVal ^ dInVal)) >> 31)!=0)     /* overflow / underflow */
59        {
60            if(temp<0)
61            {
62                dOutVal=0x80000000l;
63            }
64            else
65            {
66                dOutVal=0x7FFFFFFFl;
67            }
68        }
69
70        *dst = dOutVal;
71        dst++;
72    }
73
74    return;
75}
76
77/**********************************************************************************/
78
79
80
81