/*
 * 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