/*
 * LIBOIL - Library of Optimized Inner Loops
 * Copyright (c) 2003,2004 David A. Schleef <ds@schleef.org>
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */
//Portions Copyright (c)  2008-2009 Nokia Corporation and/or its subsidiary(-ies). All rights reserved. 

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

#include <liboil/liboilfunction.h>
#include "liboil/simdpack/simdpack.h"

#include <math.h>

static void
average2_u8_trick (uint8_t * dest, int dstr, uint8_t *src1, int sstr1,
    uint8_t *src2, int sstr2, int n)
{
  unsigned int x, y, d;

  while (n&3) {
    *dest = (*src1 + *src2) >> 1;
    src1 += sstr1;
    src2 += sstr2;
    dest += dstr;
    n--;
  }
  while (n > 0) {
    x = (src1[0] << 24) | (src1[sstr1] << 16) | (src1[2 *
            sstr1] << 8) | (src1[3 * sstr1]);
    y = (src2[0] << 24) | (src2[sstr2] << 16) | (src2[2 *
            sstr2] << 8) | (src2[3 * sstr2]);
    d = (((x ^ y) & 0xfefefefe) >> 1) + (x & y);
    dest[0] = (d >> 24);
    dest[1*dstr] = (d >> 16);
    dest[2*dstr] = (d >> 8);
    dest[3*dstr] = (d >> 0);
    src1 += 4 * sstr1;
    src2 += 4 * sstr2;
    dest += 4 * dstr;
    n -= 4;
  }
}

OIL_DEFINE_IMPL (average2_u8_trick, average2_u8);

static void
average2_u8_fast (uint8_t * dest, int dstr, uint8_t *src1, int sstr1,
    uint8_t *src2, int sstr2, int n)
{
  while (n > 0) {
    *dest = (*src1 + *src2) >> 1;
    src1 += sstr1;
    src2 += sstr2;
    dest += dstr;
    n--;
  }
}

OIL_DEFINE_IMPL (average2_u8_fast, average2_u8);

static void
average2_u8_unroll4 (uint8_t * dest, int dstr, uint8_t *src1, int sstr1,
    uint8_t *src2, int sstr2, int n)
{
  while (n & 0x3) {
    *dest = (*src1 + *src2) >> 1;
    dest += dstr;
    src1 += sstr1;
    src2 += sstr2;
    n--;
  }
  while (n > 0) {
    *dest = (*src1 + *src2) >> 1;
    dest += dstr;
    src1 += sstr1;
    src2 += sstr2;
    *dest = (*src1 + *src2) >> 1;
    dest += dstr;
    src1 += sstr1;
    src2 += sstr2;
    *dest = (*src1 + *src2) >> 1;
    dest += dstr;
    src1 += sstr1;
    src2 += sstr2;
    *dest = (*src1 + *src2) >> 1;
    dest += dstr;
    src1 += sstr1;
    src2 += sstr2;
    n -= 4;
  }
}

OIL_DEFINE_IMPL (average2_u8_unroll4, average2_u8);



#ifdef	__SYMBIAN32__
 
OilFunctionImpl* __oil_function_impl_average2_u8_trick() {
		return &_oil_function_impl_average2_u8_trick;
}
#endif

#ifdef	__SYMBIAN32__
 
OilFunctionImpl* __oil_function_impl_average2_u8_fast() {
		return &_oil_function_impl_average2_u8_fast;
}
#endif

#ifdef	__SYMBIAN32__
 
OilFunctionImpl* __oil_function_impl_average2_u8_unroll4() {
		return &_oil_function_impl_average2_u8_unroll4;
}
#endif