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 #ifdef BUILD_FLOAT
     68 void Mac3s_Sat_Float(const LVM_FLOAT *src,
     69                      const LVM_FLOAT val,
     70                      LVM_FLOAT *dst,
     71                      LVM_INT16 n)
     72 {
     73     LVM_INT16 ii;
     74     LVM_FLOAT srcval;
     75     LVM_FLOAT Temp,dInVal;
     76 
     77     for (ii = n; ii != 0; ii--)
     78     {
     79         srcval = *src;
     80         src++;
     81 
     82         Temp = srcval * val;
     83 
     84         dInVal  = (LVM_FLOAT)*dst;
     85         Temp = Temp + dInVal;
     86 
     87         if (Temp > 1.000000f)
     88         {
     89             *dst = 1.000000f;
     90         }
     91         else if (Temp < -1.000000f)
     92         {
     93             *dst = -1.000000f;
     94         }
     95         else
     96         {
     97             *dst = Temp;
     98         }
     99         dst++;
    100     }
    101 
    102     return;
    103 }
    104 #endif
    105 /**********************************************************************************/
    106 
    107 
    108 
    109