/*

 * 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