/*

  * Copyright (c) 2005

  *	Eric Anholt.  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/liboilclasses.h>

 #include <liboil/liboilfunction.h>

 #ifdef HAVE_GCC_ASM      

 #include <mmintrin.h>

 #endif

 #ifdef ENABLE_BROKEN_IMPLS

 union m64_int {

   __m64 m64;

   uint64_t ull;

 };

 static const struct _MMXData {

   union m64_int mmx_4x0080;

 } c = {

     .mmx_4x0080.ull =	0x0080008000800080ULL,

 };

 #define MC(x) (c.mmx_##x.m64)

 static void

 recon8x8_intra_mmx (uint8_t *dest, int ds, int16_t *change)

 {

   int i;

   __m64 offset = MC(4x0080);

   for (i = 8; i; i--) {

     __m64 mm0, mm1, c0, c1;

     c0 = ((__m64 *)change)[0];

     c1 = ((__m64 *)change)[1];

     mm0 = _mm_adds_pi16(c0, offset);

     mm1 = _mm_adds_pi16(c1, offset);

     *(__m64 *)dest = _mm_packs_pu16(mm0, mm1);

     dest += ds;

     change += 8;

   }

   _mm_empty();

 }

 OIL_DEFINE_IMPL_FULL (recon8x8_intra_mmx, recon8x8_intra, OIL_IMPL_FLAG_MMX);

 #endif

 static void

 recon8x8_inter_mmx (uint8_t *dest, int ds, uint8_t *src, int ss,

     int16_t *change, int dss)

 {

 #ifdef HAVE_GCC_ASM          

   int i;

   for (i = 8; i; i--) {

     __m64 mm0, mm1, c0, c1;

     c0 = ((__m64 *)change)[0];

     c1 = ((__m64 *)change)[1];

     mm0 = _mm_unpacklo_pi8(*(__m64 *)src, _mm_setzero_si64());

     mm1 = _mm_unpackhi_pi8(*(__m64 *)src, _mm_setzero_si64());

     mm0 = _mm_adds_pi16(mm0, c0);

     mm1 = _mm_adds_pi16(mm1, c1);

     *(__m64 *)dest = _mm_packs_pu16(mm0, mm1);

     change += 8;

     dest += ds;

     src += ss;

   }

   _mm_empty();

 #endif  

 }

 OIL_DEFINE_IMPL_FULL (recon8x8_inter_mmx, recon8x8_inter, OIL_IMPL_FLAG_MMX);

 static void

 recon8x8_inter2_mmx (uint8_t *dest, int ds, uint8_t *s1, int ss1, uint8_t *s2,

     int ss2, int16_t *change)

 {

   int i;

 #ifdef HAVE_GCC_ASM   

   for (i = 8; i; i--) {

     __m64 mm0, mm1, c0, c1;

     mm0 = _mm_adds_pu16(

 	_mm_unpacklo_pi8(*(__m64 *)s1, _mm_setzero_si64()),

 	_mm_unpacklo_pi8(*(__m64 *)s2, _mm_setzero_si64()));

     mm1 = _mm_adds_pu16(

 	_mm_unpackhi_pi8(*(__m64 *)s1, _mm_setzero_si64()),

 	_mm_unpackhi_pi8(*(__m64 *)s2, _mm_setzero_si64()));

     c0 = ((__m64 *)change)[0];

     c1 = ((__m64 *)change)[1];

     mm0 = _mm_srli_pi16(mm0, 1);

     mm1 = _mm_srli_pi16(mm1, 1);

     mm0 = _mm_adds_pi16(mm0, c0);

     mm1 = _mm_adds_pi16(mm1, c1);

     *(__m64 *)dest = _mm_packs_pu16(mm0, mm1);

     change += 8;

     dest += ds;

     s1 += ss1;

     s2 += ss2;

   }

   _mm_empty();

 #endif

 }

 OIL_DEFINE_IMPL_FULL (recon8x8_inter2_mmx, recon8x8_inter2, OIL_IMPL_FLAG_MMX);

 #if 0

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_recon8x8_intra_mmx() {

 		return &_oil_function_impl_recon8x8_intra_mmx;

 }

 #endif

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_recon8x8_inter_mmx() {

 		return &_oil_function_impl_recon8x8_inter_mmx;

 }

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_recon8x8_inter2_mmx() {

 		return &_oil_function_impl_recon8x8_inter2_mmx;

 }

 #endif