1 /*

     2  * LIBOIL - Library of Optimized Inner Loops

     3  * Copyright (c) 2003,2004 David A. Schleef <ds@schleef.org>

     4  * All rights reserved.

     5  *

     6  * Redistribution and use in source and binary forms, with or without

     7  * modification, are permitted provided that the following conditions

     8  * are met:

     9  * 1. Redistributions of source code must retain the above copyright

    10  *    notice, this list of conditions and the following disclaimer.

    11  * 2. Redistributions in binary form must reproduce the above copyright

    12  *    notice, this list of conditions and the following disclaimer in the

    13  *    documentation and/or other materials provided with the distribution.

    14  * 

    15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR

    16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED

    17  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE

    18  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,

    19  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES

    20  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR

    21  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)

    22  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,

    23  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING

    24  * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE

    25  * POSSIBILITY OF SUCH DAMAGE.

    26  */

    27 //Portions Copyright (c)  2008-2009 Nokia Corporation and/or its subsidiary(-ies). All rights reserved. 

    28 

    29 #ifdef HAVE_CONFIG_H

    30 #include "config.h"

    31 #endif

    32 

    33 #include <liboil/liboilfunction.h>

    34 #include "liboil/simdpack/simdpack.h"

    35 

    36 #include <math.h>

    37 

    38 static void

    39 average2_u8_trick (uint8_t * dest, int dstr, uint8_t *src1, int sstr1,

    40     uint8_t *src2, int sstr2, int n)

    41 {

    42   unsigned int x, y, d;

    43 

    44   while (n&3) {

    45     *dest = (*src1 + *src2) >> 1;

    46     src1 += sstr1;

    47     src2 += sstr2;

    48     dest += dstr;

    49     n--;

    50   }

    51   while (n > 0) {

    52     x = (src1[0] << 24) | (src1[sstr1] << 16) | (src1[2 *

    53             sstr1] << 8) | (src1[3 * sstr1]);

    54     y = (src2[0] << 24) | (src2[sstr2] << 16) | (src2[2 *

    55             sstr2] << 8) | (src2[3 * sstr2]);

    56     d = (((x ^ y) & 0xfefefefe) >> 1) + (x & y);

    57     dest[0] = (d >> 24);

    58     dest[1*dstr] = (d >> 16);

    59     dest[2*dstr] = (d >> 8);

    60     dest[3*dstr] = (d >> 0);

    61     src1 += 4 * sstr1;

    62     src2 += 4 * sstr2;

    63     dest += 4 * dstr;

    64     n -= 4;

    65   }

    66 }

    67 

    68 OIL_DEFINE_IMPL (average2_u8_trick, average2_u8);

    69 

    70 static void

    71 average2_u8_fast (uint8_t * dest, int dstr, uint8_t *src1, int sstr1,

    72     uint8_t *src2, int sstr2, int n)

    73 {

    74   while (n > 0) {

    75     *dest = (*src1 + *src2) >> 1;

    76     src1 += sstr1;

    77     src2 += sstr2;

    78     dest += dstr;

    79     n--;

    80   }

    81 }

    82 

    83 OIL_DEFINE_IMPL (average2_u8_fast, average2_u8);

    84 

    85 static void

    86 average2_u8_unroll4 (uint8_t * dest, int dstr, uint8_t *src1, int sstr1,

    87     uint8_t *src2, int sstr2, int n)

    88 {

    89   while (n & 0x3) {

    90     *dest = (*src1 + *src2) >> 1;

    91     dest += dstr;

    92     src1 += sstr1;

    93     src2 += sstr2;

    94     n--;

    95   }

    96   while (n > 0) {

    97     *dest = (*src1 + *src2) >> 1;

    98     dest += dstr;

    99     src1 += sstr1;

   100     src2 += sstr2;

   101     *dest = (*src1 + *src2) >> 1;

   102     dest += dstr;

   103     src1 += sstr1;

   104     src2 += sstr2;

   105     *dest = (*src1 + *src2) >> 1;

   106     dest += dstr;

   107     src1 += sstr1;

   108     src2 += sstr2;

   109     *dest = (*src1 + *src2) >> 1;

   110     dest += dstr;

   111     src1 += sstr1;

   112     src2 += sstr2;

   113     n -= 4;

   114   }

   115 }

   116 

   117 OIL_DEFINE_IMPL (average2_u8_unroll4, average2_u8);

   118 

   119 

   120 

   121 #ifdef	__SYMBIAN32__

   122  

   123 OilFunctionImpl* __oil_function_impl_average2_u8_trick() {

   124 		return &_oil_function_impl_average2_u8_trick;

   125 }

   126 #endif

   127 

   128 #ifdef	__SYMBIAN32__

   129  

   130 OilFunctionImpl* __oil_function_impl_average2_u8_fast() {

   131 		return &_oil_function_impl_average2_u8_fast;

   132 }

   133 #endif

   134 

   135 #ifdef	__SYMBIAN32__

   136  

   137 OilFunctionImpl* __oil_function_impl_average2_u8_unroll4() {

   138 		return &_oil_function_impl_average2_u8_unroll4;

   139 }

   140 #endif

   141