sl@0: /*
sl@0:  * LIBOIL - Library of Optimized Inner Loops
sl@0:  * Copyright (c) 2003,2004 David A. Schleef <ds@schleef.org>
sl@0:  * All rights reserved.
sl@0:  *
sl@0:  * Redistribution and use in source and binary forms, with or without
sl@0:  * modification, are permitted provided that the following conditions
sl@0:  * are met:
sl@0:  * 1. Redistributions of source code must retain the above copyright
sl@0:  *    notice, this list of conditions and the following disclaimer.
sl@0:  * 2. Redistributions in binary form must reproduce the above copyright
sl@0:  *    notice, this list of conditions and the following disclaimer in the
sl@0:  *    documentation and/or other materials provided with the distribution.
sl@0:  * 
sl@0:  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
sl@0:  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
sl@0:  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
sl@0:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
sl@0:  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
sl@0:  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
sl@0:  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
sl@0:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
sl@0:  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
sl@0:  * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
sl@0:  * POSSIBILITY OF SUCH DAMAGE.
sl@0:  */
sl@0: //Portions Copyright (c)  2008-2009 Nokia Corporation and/or its subsidiary(-ies). All rights reserved. 
sl@0: 
sl@0: #ifdef HAVE_CONFIG_H
sl@0: #include "config.h"
sl@0: #endif
sl@0: 
sl@0: #include <liboil/liboil.h>
sl@0: #include <liboil/liboilfunction.h>
sl@0: 
sl@0: OIL_DECLARE_CLASS (argb_paint_u8);
sl@0: 
sl@0: 
sl@0: #define div255(x) (((x + 128) + ((x + 128)>>8))>>8)
sl@0: #define blend(x,y,a) div255((x)*(a) + (y)*(255-(a)))
sl@0: 
sl@0: static short constants[][4] = {
sl@0:   { 255, 255, 255, 255 },
sl@0:   { 128, 128, 128, 128 }
sl@0: };
sl@0: 
sl@0: static void
sl@0: argb_paint_u8_mmx (uint8_t *dest, uint8_t *color, uint8_t *alpha, int n)
sl@0: {
sl@0: #if !defined(__WINSCW__) && !defined(__WINS__)      
sl@0:   if (n<1)return;
sl@0:   asm volatile (
sl@0:       "  pxor %%mm0, %%mm0\n"
sl@0:       "  movq (%1), %%mm3\n"
sl@0:       "  punpcklbw %%mm0, %%mm3\n"
sl@0:       "  movl $0, %1\n"
sl@0:       "1:\n"
sl@0:       "  movq (%0), %%mm1\n"
sl@0:       "  punpcklbw %%mm0, %%mm1\n"
sl@0:       "  movb (%2), %%al\n"
sl@0:       "  je 4f\n"
sl@0:       "  cmpl $255, %1\n"
sl@0:       "  jne 2f\n"
sl@0:       "  movq %%mm3, %%mm2\n"
sl@0:       "  jmp 3f\n"
sl@0:       "2:\n"
sl@0:       "  movd %1, %%mm2\n"
sl@0:       "  pshufw $0x00, %%mm2, %%mm2\n"
sl@0:       "  movq 0(%4), %%mm4\n"
sl@0:       "  psubw %%mm2, %%mm4\n"
sl@0:       "  pmullw %%mm1, %%mm4\n"
sl@0:       "  pmullw %%mm3, %%mm2\n"
sl@0:       "  paddw %%mm4, %%mm2\n"
sl@0:       "  paddw 8(%4), %%mm2\n"
sl@0:       "  movq %%mm2, %%mm1\n"
sl@0:       "  psrlw $8, %%mm1\n"
sl@0:       "  paddw %%mm1, %%mm2\n"
sl@0:       "  psrlw $8, %%mm2\n"
sl@0:       "3: \n"
sl@0:       "  packuswb %%mm0, %%mm2\n"
sl@0:       "  movd %%mm2, (%0)\n"
sl@0:       "4:\n"
sl@0:       "  add $4, %0\n"
sl@0:       "  add $1, %2\n"
sl@0:       "  decl %3\n"
sl@0:       "  jne 1b\n"
sl@0:       "  emms\n"
sl@0:       : "+r" (dest), "+a" (color), "+r" (alpha), "+r" (n)
sl@0:       : "r" (&constants));
sl@0: #endif 
sl@0: }
sl@0: OIL_DEFINE_IMPL_FULL (argb_paint_u8_mmx, argb_paint_u8, OIL_IMPL_FLAG_MMX|OIL_IMPL_FLAG_MMXEXT);
sl@0: 
sl@0: 
sl@0: 
sl@0: 
sl@0: #ifdef	__SYMBIAN32__
sl@0:  
sl@0: OilFunctionImpl* __oil_function_impl_argb_paint_u8_mmx, argb_paint_u8() {
sl@0: 		return &_oil_function_impl_argb_paint_u8_mmx, argb_paint_u8;
sl@0: }
sl@0: #endif
sl@0: