/*
 * 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 <math.h>

OIL_DECLARE_CLASS(trans8x8_u16);

/* this could use additional work. */
static void
trans8x8_u16_mmx (uint16_t *dest, int dstr, uint16_t *src, int sstr)
{
#if !defined(__WINSCW__) && !defined(__WINS__)      
  asm volatile (
      "  leal (%3,%3,2),%%eax \n"         // UBER 0:
      "  movq (%1), %%mm0 \n"             // UBER 1:
      "  movq (%1,%3,2), %%mm2 \n"        // UBER 2: 
      "  movq %%mm0, %%mm4 \n"            // UBER 3: 1
      "  movq %%mm2, %%mm5 \n"            // UBER 4: 2
      "  punpcklwd (%1,%3), %%mm0 \n"     // UBER 5: 1
      "  punpcklwd (%1,%%eax), %%mm2 \n"  // UBER 6: 0 2
      "  punpckhwd (%1,%3), %%mm4 \n"     // UBER 7: 3
      "  punpckhwd (%1,%%eax), %%mm5 \n"  // UBER 8: 4
      "  movq %%mm0, %%mm1 \n"            // UBER 9: 5
      "  movq %%mm4, %%mm3 \n"            // UBER 10: 7
      "  punpckldq %%mm2, %%mm0 \n"       // UBER 11: 5 6
      "  punpckldq %%mm5, %%mm4 \n"       // UBER 12: 7 8
      "  punpckhdq %%mm2, %%mm1 \n"       // UBER 13: 6 9
      "  punpckhdq %%mm5, %%mm3 \n"       // UBER 14: 9 10
      "  leal (%2,%2,2),%%eax \n"         // UBER 15: 8
      "  movq %%mm0, 0(%0) \n"            // UBER 16: 11
      "  movq %%mm1, (%0,%2) \n"          // UBER 17: 13
      "  movq %%mm4, (%0,%2,2) \n"        // UBER 18: 12
      "  movq %%mm3, (%0,%%eax) \n"       // UBER 19: 14 15

      "  leal (%3,%3,2),%%eax \n"
      "  movq 8(%1), %%mm0 \n"
      "  movq 8(%1,%3,2), %%mm2 \n"
      "  movq %%mm0, %%mm4 \n"
      "  movq %%mm2, %%mm5 \n"
      "  punpcklwd 8(%1,%3), %%mm0 \n"
      "  punpcklwd 8(%1,%%eax), %%mm2 \n"
      "  punpckhwd 8(%1,%3), %%mm4 \n"
      "  punpckhwd 8(%1,%%eax), %%mm5 \n"
      "  movq %%mm0, %%mm1 \n"
      "  movq %%mm4, %%mm3 \n"
      "  punpckldq %%mm2, %%mm0 \n"
      "  punpckldq %%mm5, %%mm4 \n"
      "  punpckhdq %%mm2, %%mm1 \n"
      "  punpckhdq %%mm5, %%mm3 \n"
      "  leal (%2,%2,2),%%eax \n"
      "  leal (%0,%2,4),%0 \n"
      "  movq %%mm0, 0(%0) \n"
      "  movq %%mm1, (%0,%2) \n"
      "  movq %%mm4, (%0,%2,2) \n"
      "  movq %%mm3, (%0,%%eax) \n"

      "  leal (%1,%3,4),%1 \n"
      "  leal (%3,%3,2),%%eax \n"
      "  movq 0(%1), %%mm0 \n"
      "  movq 0(%1,%3,2), %%mm2 \n"
      "  movq %%mm0, %%mm4 \n"
      "  movq %%mm2, %%mm5 \n"
      "  punpcklwd 0(%1,%3), %%mm0 \n"
      "  punpcklwd 0(%1,%%eax), %%mm2 \n"
      "  punpckhwd 0(%1,%3), %%mm4 \n"
      "  punpckhwd 0(%1,%%eax), %%mm5 \n"
      "  movq %%mm0, %%mm1 \n"
      "  movq %%mm4, %%mm3 \n"
      "  punpckldq %%mm2, %%mm0 \n"
      "  punpckldq %%mm5, %%mm4 \n"
      "  punpckhdq %%mm2, %%mm1 \n"
      "  punpckhdq %%mm5, %%mm3 \n"
      "  leal (%2,%2,2),%%eax \n"
      "  neg %2 \n"
      "  leal (%0,%2,4),%0 \n"
      "  neg %2 \n"
      "  movq %%mm0, 8(%0) \n"
      "  movq %%mm1, 8(%0,%2) \n"
      "  movq %%mm4, 8(%0,%2,2) \n"
      "  movq %%mm3, 8(%0,%%eax) \n"

      "  leal (%3,%3,2),%%eax \n"
      "  movq 8(%1), %%mm0 \n"
      "  movq 8(%1,%3,2), %%mm2 \n"
      "  movq %%mm0, %%mm4 \n"
      "  movq %%mm2, %%mm5 \n"
      "  punpcklwd 8(%1,%3), %%mm0 \n"
      "  punpcklwd 8(%1,%%eax), %%mm2 \n"
      "  punpckhwd 8(%1,%3), %%mm4 \n"
      "  punpckhwd 8(%1,%%eax), %%mm5 \n"
      "  movq %%mm0, %%mm1 \n"
      "  movq %%mm4, %%mm3 \n"
      "  punpckldq %%mm2, %%mm0 \n"
      "  punpckldq %%mm5, %%mm4 \n"
      "  punpckhdq %%mm2, %%mm1 \n"
      "  punpckhdq %%mm5, %%mm3 \n"
      "  leal (%2,%2,2),%%eax \n"
      "  leal (%0,%2,4),%0 \n"
      "  movq %%mm0, 8(%0) \n"
      "  movq %%mm1, 8(%0,%2) \n"
      "  movq %%mm4, 8(%0,%2,2) \n"
      "  movq %%mm3, 8(%0,%%eax) \n"
      "  emms \n"
      : "+r" (dest), "+r" (src), "+r" (dstr), "+r" (sstr)
      :
      : "eax");
#endif
}
OIL_DEFINE_IMPL_FULL (trans8x8_u16_mmx, trans8x8_u16, OIL_IMPL_FLAG_MMX);

static void
trans8x8_u16_asm1 (uint16_t *dest, int dstr, uint16_t *src, int sstr)
{
#if !defined(__WINSCW__) && !defined(__WINS__)      
  int saved_ebx = 0;
  asm (
      "  movl %%ebx, %4 \n"
      "  movl %0, %%ecx \n"
      "  movl %2, %%ebx \n"
      "  movl %1, %%edx \n"
      "  lea (%%ecx,%%edx,8), %%esi \n"
      "  sub %%edx, %%esi\n "
      "  movl $7, %%edi \n"
      "1: \n"

      "  mov (%%ebx), %%ax \n"
      "  mov %%ax,(%%ecx) \n"
      "  mov 2(%%ebx), %%ax \n"
      "  mov %%ax,(%%ecx,%%edx,1) \n"
      "  mov 4(%%ebx), %%ax \n"
      "  mov %%ax,(%%ecx,%%edx,2) \n"
      "  mov 8(%%ebx), %%ax \n"
      "  mov %%ax,(%%ecx,%%edx,4) \n"

      "  neg %%edx \n"

      "  mov 6(%%ebx), %%ax \n"
      "  mov %%ax,(%%esi,%%edx,4) \n"
      "  mov 10(%%ebx), %%ax \n"
      "  mov %%ax,(%%esi,%%edx,2) \n"
      "  mov 12(%%ebx), %%ax \n"
      "  mov %%ax,(%%esi,%%edx,1) \n"
      "  mov 14(%%ebx), %%ax \n"
      "  mov %%ax,(%%esi) \n"

      "  neg %%edx \n"
      "  add %3, %%ebx \n"
      "  add $2, %%ecx \n"
      "  add $2, %%esi \n"

      "  dec %%edi \n"
      "  jge 1b \n"
      "  movl %4, %%ebx \n"
      :
      : "m" (dest), "m" (dstr), "m" (src), "m" (sstr), "m" (saved_ebx)
      : "eax", "ecx", "edx", "esi", "edi");
#endif
}
OIL_DEFINE_IMPL (trans8x8_u16_asm1, trans8x8_u16);

static void
trans8x8_u16_asm2 (uint16_t *dest, int dstr, uint16_t *src, int sstr)
{
#if !defined(__WINSCW__) && !defined(__WINS__)      
  int i;
  int saved_ebx = 0;
  asm (
      "  movl %%ebx, %5 \n"
      "  movl %0, %%ecx \n"
      "  movl %2, %%ebx \n"
      "  movl %1, %%edx \n"
      "  lea (%%ecx,%%edx,8), %%esi \n"
      "  sub %%edx, %%esi\n "
      "  movl $7, %4 \n"
      "  movl %%edx, %%edi \n"
      "  negl %%edi \n"
      "1: \n"

      "  movl (%%ebx), %%eax \n"
      "  mov %%ax,(%%ecx) \n"
      "  shr $16, %%eax \n"
      "  mov %%ax,(%%ecx,%%edx,1) \n"

      "  movl 4(%%ebx), %%eax \n"
      "  mov %%ax,(%%ecx,%%edx,2) \n"
      "  shr $16, %%eax \n"
      "  mov %%ax,(%%esi,%%edi,4) \n"

      "  movl 8(%%ebx), %%eax \n"
      "  mov %%ax,(%%ecx,%%edx,4) \n"
      "  shr $16, %%eax \n"
      "  mov %%ax,(%%esi,%%edi,2) \n"

      "  movl 12(%%ebx), %%eax \n"
      "  mov %%ax,(%%esi,%%edi,1) \n"
      "  shr $16, %%eax \n"
      "  mov %%ax,(%%esi) \n"

      "  add %3, %%ebx \n"
      "  add $2, %%ecx \n"
      "  add $2, %%esi \n"

      "  decl %4 \n"
      "  jge 1b \n"
      "  movl %5, %%ebx \n"
      :
      : "m" (dest), "m" (dstr), "m" (src), "m" (sstr), "m" (i), "m" (saved_ebx)
      : "eax", "ecx", "edx", "esi", "edi");
#endif
}
OIL_DEFINE_IMPL (trans8x8_u16_asm2, trans8x8_u16);



#ifdef	__SYMBIAN32__
 
OilFunctionImpl* __oil_function_impl_trans8x8_u16_mmx, trans8x8_u16() {
		return &_oil_function_impl_trans8x8_u16_mmx, trans8x8_u16;
}
#endif



#ifdef	__SYMBIAN32__
 
OilFunctionImpl* __oil_function_impl_trans8x8_u16_asm1() {
		return &_oil_function_impl_trans8x8_u16_asm1;
}
#endif

#ifdef	__SYMBIAN32__
 
OilFunctionImpl* __oil_function_impl_trans8x8_u16_asm2() {
		return &_oil_function_impl_trans8x8_u16_asm2;
}
#endif