frameworks/base/media/libeffects/lvm/lib/Common/src/Add2_Sat_32x32.c

   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 /**********************************************************************************
  26    FUNCTION ADD2_SAT_32X32
  27 ***********************************************************************************/
  28
  29 void Add2_Sat_32x32( const LVM_INT32  *src,
  30                            LVM_INT32  *dst,
  31                            LVM_INT16  n )
  32 {
  33     LVM_INT32 a,b,c;
  34     LVM_INT16 ii;
  35     for (ii = n; ii != 0; ii--)
  36     {
  37         a=*src;
  38         src++;
  39
  40         b=*dst;
  41         c=a+b;
  42         if ((((c ^ a) & (c ^ b)) >> 31)!=0)     /* overflow / underflow */
  43         {
  44             if(a<0)
  45             {
  46                 c=0x80000000l;
  47             }
  48             else
  49             {
  50                 c=0x7FFFFFFFl;
  51             }
  52         }
  53
  54         *dst = c;
  55         dst++;
  56     }
  57     return;
  58 }
  59
  60 /**********************************************************************************/