dsputil_mmx_avg.h

tcpmp播放器的flv插件

/*
 * DSP utils : average functions are compiled twice for 3dnow/mmx2
 * Copyright (c) 2000, 2001 Fabrice Bellard.
 * Copyright (c) 2002-2004 Michael Niedermayer
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 * MMX optimization by Nick Kurshev <[e-mail]>
 * mostly rewritten by Michael Niedermayer <[e-mail]>
 * and improved by Zdenek Kabelac <[e-mail]>
 */
 
/* XXX: we use explicit registers to avoid a gcc 2.95.2 register asm
   clobber bug - now it will work with 2.95.2 and also with -fPIC
 */
static void DEF(put_pixels8_x2)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
{
    __asm __volatile(
	"lea (%3, %3), %%"REG_a"	\n\t"
	"1:				\n\t"
	"movq (%1), %%mm0		\n\t"
	"movq (%1, %3), %%mm1		\n\t"
	PAVGB" 1(%1), %%mm0		\n\t"
	PAVGB" 1(%1, %3), %%mm1		\n\t"
	"movq %%mm0, (%2)		\n\t"
	"movq %%mm1, (%2, %3)		\n\t"
	"add %%"REG_a", %1		\n\t"
	"add %%"REG_a", %2		\n\t"
	"movq (%1), %%mm0		\n\t"
	"movq (%1, %3), %%mm1		\n\t"
	PAVGB" 1(%1), %%mm0		\n\t"
	PAVGB" 1(%1, %3), %%mm1		\n\t"
	"add %%"REG_a", %1		\n\t"
	"movq %%mm0, (%2)		\n\t"
	"movq %%mm1, (%2, %3)		\n\t"
	"add %%"REG_a", %2		\n\t"
	"subl $4, %0			\n\t"
	"jnz 1b				\n\t"
	:"+g"(h), "+S"(pixels), "+D"(block)
	:"r" ((long)line_size)
	:"%"REG_a, "memory");
}

static void DEF(put_pixels4_l2)(uint8_t *dst, uint8_t *src1, uint8_t *src2, int dstStride, int src1Stride, int h)
{
    __asm __volatile(
	"testl $1, %0			\n\t"
	    " jz 1f				\n\t"
	"movd	(%1), %%mm0		\n\t"
	"movd	(%2), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	"add	$4, %2			\n\t"
	PAVGB" %%mm1, %%mm0		\n\t"
	"movd	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"decl	%0			\n\t"
	"1:				\n\t"
	"movd	(%1), %%mm0		\n\t"
	"add	%4, %1			\n\t"
	"movd	(%1), %%mm1		\n\t"
	"movd	(%2), %%mm2		\n\t"
	"movd	4(%2), %%mm3		\n\t"
	"add	%4, %1			\n\t"
	PAVGB" %%mm2, %%mm0		\n\t"
	PAVGB" %%mm3, %%mm1		\n\t"
	"movd	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"movd	%%mm1, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"movd	(%1), %%mm0		\n\t"
	"add	%4, %1			\n\t"
	"movd	(%1), %%mm1		\n\t"
	"movd	8(%2), %%mm2		\n\t"
	"movd	12(%2), %%mm3		\n\t"
	"add	%4, %1			\n\t"
	PAVGB" %%mm2, %%mm0		\n\t"
	PAVGB" %%mm3, %%mm1		\n\t"
	"movd	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"movd	%%mm1, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"add	$16, %2			\n\t"
	"subl	$4, %0			\n\t"
	"jnz	1b			\n\t"
#ifdef PIC //Note "+bm" and "+mb" are buggy too (with gcc 3.2.2 at least) and cant be used
	:"+m"(h), "+a"(src1), "+c"(src2), "+d"(dst)
#else
	:"+b"(h), "+a"(src1), "+c"(src2), "+d"(dst)
#endif
	:"S"((long)src1Stride), "D"((long)dstStride)
	:"memory"); 
}


static void DEF(put_pixels8_l2)(uint8_t *dst, uint8_t *src1, uint8_t *src2, int dstStride, int src1Stride, int h)
{
    __asm __volatile(
	"testl $1, %0			\n\t"
	    " jz 1f				\n\t"
	"movq	(%1), %%mm0		\n\t"
	"movq	(%2), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	"add	$8, %2			\n\t"
	PAVGB" %%mm1, %%mm0		\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"decl	%0			\n\t"
	"1:				\n\t"
	"movq	(%1), %%mm0		\n\t"
	"add	%4, %1			\n\t"
	"movq	(%1), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	PAVGB" (%2), %%mm0		\n\t"
	PAVGB" 8(%2), %%mm1		\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"movq	%%mm1, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"movq	(%1), %%mm0		\n\t"
	"add	%4, %1			\n\t"
	"movq	(%1), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	PAVGB" 16(%2), %%mm0		\n\t"
	PAVGB" 24(%2), %%mm1		\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"movq	%%mm1, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"add	$32, %2			\n\t"
	"subl	$4, %0			\n\t"
	"jnz	1b			\n\t"
#ifdef PIC //Note "+bm" and "+mb" are buggy too (with gcc 3.2.2 at least) and cant be used
	:"+m"(h), "+a"(src1), "+c"(src2), "+d"(dst)
#else
	:"+b"(h), "+a"(src1), "+c"(src2), "+d"(dst)
#endif
	:"S"((long)src1Stride), "D"((long)dstStride)
	:"memory"); 
//the following should be used, though better not with gcc ...
/*	:"+g"(h), "+r"(src1), "+r"(src2), "+r"(dst)
	:"r"(src1Stride), "r"(dstStride)
	:"memory");*/
}

static void DEF(put_no_rnd_pixels8_l2)(uint8_t *dst, uint8_t *src1, uint8_t *src2, int dstStride, int src1Stride, int h)
{
    __asm __volatile(
	"pcmpeqb %%mm6, %%mm6	\n\t"
	"testl $1, %0			\n\t"
	    " jz 1f				\n\t"
	"movq	(%1), %%mm0		\n\t"
	"movq	(%2), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	"add	$8, %2			\n\t"
	"pxor %%mm6, %%mm0		\n\t"
	"pxor %%mm6, %%mm1		\n\t"
	PAVGB" %%mm1, %%mm0		\n\t"
	"pxor %%mm6, %%mm0		\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"decl	%0			\n\t"
	"1:				\n\t"
	"movq	(%1), %%mm0		\n\t"
	"add	%4, %1			\n\t"
	"movq	(%1), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	"movq	(%2), %%mm2		\n\t"
	"movq	8(%2), %%mm3		\n\t"
	"pxor %%mm6, %%mm0		\n\t"
	"pxor %%mm6, %%mm1		\n\t"
	"pxor %%mm6, %%mm2		\n\t"
	"pxor %%mm6, %%mm3		\n\t"
	PAVGB" %%mm2, %%mm0		\n\t"
	PAVGB" %%mm3, %%mm1		\n\t"
	"pxor %%mm6, %%mm0		\n\t"
	"pxor %%mm6, %%mm1		\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"movq	%%mm1, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"movq	(%1), %%mm0		\n\t"
	"add	%4, %1			\n\t"
	"movq	(%1), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	"movq	16(%2), %%mm2		\n\t"
	"movq	24(%2), %%mm3		\n\t"
	"pxor %%mm6, %%mm0		\n\t"
	"pxor %%mm6, %%mm1		\n\t"
	"pxor %%mm6, %%mm2		\n\t"
	"pxor %%mm6, %%mm3		\n\t"
	PAVGB" %%mm2, %%mm0		\n\t"
	PAVGB" %%mm3, %%mm1		\n\t"
	"pxor %%mm6, %%mm0		\n\t"
	"pxor %%mm6, %%mm1		\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"movq	%%mm1, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"add	$32, %2			\n\t"
	"subl	$4, %0			\n\t"
	"jnz	1b			\n\t"
#ifdef PIC //Note "+bm" and "+mb" are buggy too (with gcc 3.2.2 at least) and cant be used
	:"+m"(h), "+a"(src1), "+c"(src2), "+d"(dst)
#else
	:"+b"(h), "+a"(src1), "+c"(src2), "+d"(dst)
#endif
	:"S"((long)src1Stride), "D"((long)dstStride)
	:"memory"); 
//the following should be used, though better not with gcc ...
/*	:"+g"(h), "+r"(src1), "+r"(src2), "+r"(dst)
	:"r"(src1Stride), "r"(dstStride)
	:"memory");*/
}

static void DEF(avg_pixels4_l2)(uint8_t *dst, uint8_t *src1, uint8_t *src2, int dstStride, int src1Stride, int h)
{
    __asm __volatile(
	"testl $1, %0			\n\t"
	    " jz 1f				\n\t"
	"movd	(%1), %%mm0		\n\t"
	"movd	(%2), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	"add	$4, %2			\n\t"
	PAVGB" %%mm1, %%mm0		\n\t"
	PAVGB" (%3), %%mm0		\n\t"
	"movd	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"decl	%0			\n\t"
	"1:				\n\t"
	"movd	(%1), %%mm0		\n\t"
	"add	%4, %1			\n\t"
	"movd	(%1), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	PAVGB" (%2), %%mm0		\n\t"
	PAVGB" 4(%2), %%mm1		\n\t"
	PAVGB" (%3), %%mm0	 	\n\t"
	"movd	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	PAVGB" (%3), %%mm1	 	\n\t"
	"movd	%%mm1, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"movd	(%1), %%mm0		\n\t"
	"add	%4, %1			\n\t"
	"movd	(%1), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	PAVGB" 8(%2), %%mm0		\n\t"
	PAVGB" 12(%2), %%mm1		\n\t"
	PAVGB" (%3), %%mm0	 	\n\t"
	"movd	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	PAVGB" (%3), %%mm1	 	\n\t"
	"movd	%%mm1, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"add	$16, %2			\n\t"
	"subl	$4, %0			\n\t"
	"jnz	1b			\n\t"
#ifdef PIC //Note "+bm" and "+mb" are buggy too (with gcc 3.2.2 at least) and cant be used
	:"+m"(h), "+a"(src1), "+c"(src2), "+d"(dst)
#else
	:"+b"(h), "+a"(src1), "+c"(src2), "+d"(dst)
#endif
	:"S"((long)src1Stride), "D"((long)dstStride)
	:"memory"); 
}


static void DEF(avg_pixels8_l2)(uint8_t *dst, uint8_t *src1, uint8_t *src2, int dstStride, int src1Stride, int h)
{
    __asm __volatile(
	"testl $1, %0			\n\t"
	    " jz 1f				\n\t"
	"movq	(%1), %%mm0		\n\t"
	"movq	(%2), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	"add	$8, %2			\n\t"
	PAVGB" %%mm1, %%mm0		\n\t"
	PAVGB" (%3), %%mm0		\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"decl	%0			\n\t"
	"1:				\n\t"
	"movq	(%1), %%mm0		\n\t"
	"add	%4, %1			\n\t"
	"movq	(%1), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	PAVGB" (%2), %%mm0		\n\t"
	PAVGB" 8(%2), %%mm1		\n\t"
	PAVGB" (%3), %%mm0	 	\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	PAVGB" (%3), %%mm1	 	\n\t"
	"movq	%%mm1, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"movq	(%1), %%mm0		\n\t"
	"add	%4, %1			\n\t"
	"movq	(%1), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	PAVGB" 16(%2), %%mm0		\n\t"
	PAVGB" 24(%2), %%mm1		\n\t"
	PAVGB" (%3), %%mm0	 	\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"add	%5, %3			\n\t"
	PAVGB" (%3), %%mm1	 	\n\t"
	"movq	%%mm1, (%3)		\n\t"
	"add	%5, %3			\n\t"
	"add	$32, %2			\n\t"
	"subl	$4, %0			\n\t"
	"jnz	1b			\n\t"
#ifdef PIC //Note "+bm" and "+mb" are buggy too (with gcc 3.2.2 at least) and cant be used
	:"+m"(h), "+a"(src1), "+c"(src2), "+d"(dst)
#else
	:"+b"(h), "+a"(src1), "+c"(src2), "+d"(dst)
#endif
	:"S"((long)src1Stride), "D"((long)dstStride)
	:"memory"); 
//the following should be used, though better not with gcc ...
/*	:"+g"(h), "+r"(src1), "+r"(src2), "+r"(dst)
	:"r"(src1Stride), "r"(dstStride)
	:"memory");*/
}

static void DEF(put_pixels16_x2)(uint8_t *block, const uint8_t *pixels, int line_size, int h)
{
    __asm __volatile(
	"lea (%3, %3), %%"REG_a"	\n\t"
	"1:				\n\t"
	"movq (%1), %%mm0		\n\t"
	"movq (%1, %3), %%mm1		\n\t"
	"movq 8(%1), %%mm2		\n\t"
	"movq 8(%1, %3), %%mm3		\n\t"
	PAVGB" 1(%1), %%mm0		\n\t"
	PAVGB" 1(%1, %3), %%mm1		\n\t"
	PAVGB" 9(%1), %%mm2		\n\t"
	PAVGB" 9(%1, %3), %%mm3		\n\t"
	"movq %%mm0, (%2)		\n\t"
	"movq %%mm1, (%2, %3)		\n\t"
	"movq %%mm2, 8(%2)		\n\t"
	"movq %%mm3, 8(%2, %3)		\n\t"
	"add %%"REG_a", %1		\n\t"
	"add %%"REG_a", %2		\n\t"
	"movq (%1), %%mm0		\n\t"
	"movq (%1, %3), %%mm1		\n\t"
	"movq 8(%1), %%mm2		\n\t"
	"movq 8(%1, %3), %%mm3		\n\t"
	PAVGB" 1(%1), %%mm0		\n\t"
	PAVGB" 1(%1, %3), %%mm1		\n\t"
	PAVGB" 9(%1), %%mm2		\n\t"
	PAVGB" 9(%1, %3), %%mm3		\n\t"
	"add %%"REG_a", %1		\n\t"
	"movq %%mm0, (%2)		\n\t"
	"movq %%mm1, (%2, %3)		\n\t"
	"movq %%mm2, 8(%2)		\n\t"
	"movq %%mm3, 8(%2, %3)		\n\t"
	"add %%"REG_a", %2		\n\t"
	"subl $4, %0			\n\t"
	"jnz 1b				\n\t"
	:"+g"(h), "+S"(pixels), "+D"(block)
	:"r" ((long)line_size)
	:"%"REG_a, "memory");
}

static void DEF(put_pixels16_l2)(uint8_t *dst, uint8_t *src1, uint8_t *src2, int dstStride, int src1Stride, int h)
{
    __asm __volatile(
	"testl $1, %0			\n\t"
	    " jz 1f				\n\t"
	"movq	(%1), %%mm0		\n\t"
	"movq	8(%1), %%mm1		\n\t"
	PAVGB" (%2), %%mm0		\n\t"
	PAVGB" 8(%2), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	"add	$16, %2			\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"movq	%%mm1, 8(%3)		\n\t"
	"add	%5, %3			\n\t"
	"decl	%0			\n\t"
	"1:				\n\t"
	"movq	(%1), %%mm0		\n\t"
	"movq	8(%1), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	PAVGB" (%2), %%mm0		\n\t"
	PAVGB" 8(%2), %%mm1		\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"movq	%%mm1, 8(%3)		\n\t"
	"add	%5, %3			\n\t"
	"movq	(%1), %%mm0		\n\t"
	"movq	8(%1), %%mm1		\n\t"
	"add	%4, %1			\n\t"
	PAVGB" 16(%2), %%mm0		\n\t"
	PAVGB" 24(%2), %%mm1		\n\t"
	"movq	%%mm0, (%3)		\n\t"
	"movq	%%mm1, 8(%3)		\n\t"
	"add	%5, %3			\n\t"
	"add	$32, %2			\n\t"
	"subl	$2, %0			\n\t"
	"jnz	1b			\n\t"
#ifdef PIC //Note "+bm" and "+mb" are buggy too (with gcc 3.2.2 at least) and cant be used
	:"+m"(h), "+a"(src1), "+c"(src2), "+d"(dst)
#else