Home | History | Annotate | Download | only in src
      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 
     29 void 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