|
|
|
/*
|
|
|
|
* MMX optimized DSP utils
|
|
|
|
* Copyright (c) 2000, 2001 Gerard Lantau.
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
|
|
* (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program 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 General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
|
|
*
|
|
|
|
* MMX optimization by Nick Kurshev <nickols_k@mail.ru>
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "../dsputil.h"
|
|
|
|
#include "../simple_idct.h"
|
|
|
|
|
|
|
|
int mm_flags; /* multimedia extension flags */
|
|
|
|
|
|
|
|
int pix_abs16x16_mmx(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs16x16_x2_mmx(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs16x16_y2_mmx(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs16x16_xy2_mmx(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
|
|
|
|
int pix_abs16x16_mmx2(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs16x16_x2_mmx2(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs16x16_y2_mmx2(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs16x16_xy2_mmx2(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
|
|
|
|
int pix_abs8x8_mmx(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs8x8_x2_mmx(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs8x8_y2_mmx(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs8x8_xy2_mmx(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
|
|
|
|
int pix_abs8x8_mmx2(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs8x8_x2_mmx2(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs8x8_y2_mmx2(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
int pix_abs8x8_xy2_mmx2(UINT8 *blk1, UINT8 *blk2, int lx);
|
|
|
|
|
|
|
|
/* external functions, from idct_mmx.c */
|
|
|
|
void ff_mmx_idct(DCTELEM *block);
|
|
|
|
void ff_mmxext_idct(DCTELEM *block);
|
|
|
|
|
|
|
|
/* pixel operations */
|
|
|
|
static const unsigned long long int mm_wone __attribute__ ((aligned(8))) = 0x0001000100010001LL;
|
|
|
|
static const unsigned long long int mm_wtwo __attribute__ ((aligned(8))) = 0x0002000200020002LL;
|
|
|
|
//static const unsigned short mm_wone[4] __attribute__ ((aligned(8))) = { 0x1, 0x1, 0x1, 0x1 };
|
|
|
|
//static const unsigned short mm_wtwo[4] __attribute__ ((aligned(8))) = { 0x2, 0x2, 0x2, 0x2 };
|
|
|
|
|
|
|
|
#define JUMPALIGN() __asm __volatile (".balign 8"::)
|
|
|
|
#define MOVQ_ZERO(regd) __asm __volatile ("pxor %%" #regd ", %%" #regd ::)
|
|
|
|
|
|
|
|
#ifndef PIC
|
|
|
|
#define MOVQ_WONE(regd) __asm __volatile ("movq %0, %%" #regd " \n\t" ::"m"(mm_wone))
|
|
|
|
#define MOVQ_WTWO(regd) __asm __volatile ("movq %0, %%" #regd " \n\t" ::"m"(mm_wtwo))
|
|
|
|
#else
|
|
|
|
// for shared library it's better to use this way for accessing constants
|
|
|
|
// pcmpeqd -> -1
|
|
|
|
#define MOVQ_WONE(regd) \
|
|
|
|
__asm __volatile ( \
|
|
|
|
"pcmpeqd %%" #regd ", %%" #regd " \n\t" \
|
|
|
|
"psrlw $15, %%" #regd ::)
|
|
|
|
|
|
|
|
#define MOVQ_WTWO(regd) \
|
|
|
|
__asm __volatile ( \
|
|
|
|
"pcmpeqd %%" #regd ", %%" #regd " \n\t" \
|
|
|
|
"psrlw $15, %%" #regd " \n\t" \
|
|
|
|
"psllw $1, %%" #regd ::)
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/***********************************/
|
|
|
|
/* 3Dnow specific */
|
|
|
|
|
|
|
|
#define DEF(x) x ## _3dnow
|
|
|
|
/* for Athlons PAVGUSB is prefered */
|
|
|
|
#define PAVGB "pavgusb"
|
|
|
|
|
|
|
|
#include "dsputil_mmx_avg.h"
|
|
|
|
|
|
|
|
#undef DEF
|
|
|
|
#undef PAVGB
|
|
|
|
|
|
|
|
/***********************************/
|
|
|
|
/* MMX2 specific */
|
|
|
|
|
|
|
|
#define DEF(x) x ## _sse
|
|
|
|
|
|
|
|
/* Introduced only in MMX2 set */
|
|
|
|
#define PAVGB "pavgb"
|
|
|
|
|
|
|
|
#include "dsputil_mmx_avg.h"
|
|
|
|
|
|
|
|
#undef DEF
|
|
|
|
#undef PAVGB
|
|
|
|
|
|
|
|
/***********************************/
|
|
|
|
/* standard MMX */
|
|
|
|
|
|
|
|
static void get_pixels_mmx(DCTELEM *block, const UINT8 *pixels, int line_size)
|
|
|
|
{
|
|
|
|
DCTELEM *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
/* read the pixels */
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
for(i=0;i<4;i++) {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %2, %%mm1\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
"movq %%mm2, 8%0\n\t"
|
|
|
|
"movq %%mm1, 16%0\n\t"
|
|
|
|
"movq %%mm3, 24%0\n\t"
|
|
|
|
:"=m"(*p)
|
|
|
|
:"m"(*pix), "m"(*(pix+line_size))
|
|
|
|
:"memory");
|
|
|
|
pix += line_size*2;
|
|
|
|
p += 16;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void diff_pixels_mmx(DCTELEM *block, const UINT8 *s1, const UINT8 *s2, int stride)
|
|
|
|
{
|
|
|
|
asm volatile(
|
|
|
|
".balign 16 \n\t"
|
|
|
|
"movl $-128, %%eax \n\t"
|
|
|
|
"1: \n\t"
|
|
|
|
"movq (%0), %%mm0 \n\t"
|
|
|
|
"movq (%1), %%mm2 \n\t"
|
|
|
|
"movq %%mm0, %%mm1 \n\t"
|
|
|
|
"movq %%mm2, %%mm3 \n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0 \n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm1 \n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm2 \n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3 \n\t"
|
|
|
|
"psubw %%mm2, %%mm0 \n\t"
|
|
|
|
"psubw %%mm3, %%mm1 \n\t"
|
|
|
|
"movq %%mm0, (%2, %%eax)\n\t"
|
|
|
|
"movq %%mm1, 8(%2, %%eax)\n\t"
|
|
|
|
"addl %3, %0 \n\t"
|
|
|
|
"addl %3, %1 \n\t"
|
|
|
|
"addl $16, %%eax \n\t"
|
|
|
|
"jnz 1b \n\t"
|
|
|
|
: "+r" (s1), "+r" (s2)
|
|
|
|
: "r" (block+64), "r" (stride)
|
|
|
|
: "%eax"
|
|
|
|
);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void put_pixels_clamped_mmx(const DCTELEM *block, UINT8 *pixels, int line_size)
|
|
|
|
{
|
|
|
|
const DCTELEM *p;
|
|
|
|
UINT8 *pix;
|
|
|
|
|
|
|
|
/* read the pixels */
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
/* unrolled loop */
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %3, %%mm0\n\t"
|
|
|
|
"movq 8%3, %%mm1\n\t"
|
|
|
|
"movq 16%3, %%mm2\n\t"
|
|
|
|
"movq 24%3, %%mm3\n\t"
|
|
|
|
"movq 32%3, %%mm4\n\t"
|
|
|
|
"movq 40%3, %%mm5\n\t"
|
|
|
|
"movq 48%3, %%mm6\n\t"
|
|
|
|
"movq 56%3, %%mm7\n\t"
|
|
|
|
"packuswb %%mm1, %%mm0\n\t"
|
|
|
|
"packuswb %%mm3, %%mm2\n\t"
|
|
|
|
"packuswb %%mm5, %%mm4\n\t"
|
|
|
|
"packuswb %%mm7, %%mm6\n\t"
|
|
|
|
"movq %%mm0, (%0)\n\t"
|
|
|
|
"movq %%mm2, (%0, %1)\n\t"
|
|
|
|
"movq %%mm4, (%0, %1, 2)\n\t"
|
|
|
|
"movq %%mm6, (%0, %2)\n\t"
|
|
|
|
::"r" (pix), "r" (line_size), "r" (line_size*3), "m"(*p)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size*4;
|
|
|
|
p += 32;
|
|
|
|
|
|
|
|
// if here would be an exact copy of the code above
|
|
|
|
// compiler would generate some very strange code
|
|
|
|
// thus using "r"
|
|
|
|
__asm __volatile(
|
|
|
|
"movq (%3), %%mm0\n\t"
|
|
|
|
"movq 8(%3), %%mm1\n\t"
|
|
|
|
"movq 16(%3), %%mm2\n\t"
|
|
|
|
"movq 24(%3), %%mm3\n\t"
|
|
|
|
"movq 32(%3), %%mm4\n\t"
|
|
|
|
"movq 40(%3), %%mm5\n\t"
|
|
|
|
"movq 48(%3), %%mm6\n\t"
|
|
|
|
"movq 56(%3), %%mm7\n\t"
|
|
|
|
"packuswb %%mm1, %%mm0\n\t"
|
|
|
|
"packuswb %%mm3, %%mm2\n\t"
|
|
|
|
"packuswb %%mm5, %%mm4\n\t"
|
|
|
|
"packuswb %%mm7, %%mm6\n\t"
|
|
|
|
"movq %%mm0, (%0)\n\t"
|
|
|
|
"movq %%mm2, (%0, %1)\n\t"
|
|
|
|
"movq %%mm4, (%0, %1, 2)\n\t"
|
|
|
|
"movq %%mm6, (%0, %2)\n\t"
|
|
|
|
::"r" (pix), "r" (line_size), "r" (line_size*3), "r"(p)
|
|
|
|
:"memory");
|
|
|
|
}
|
|
|
|
|
|
|
|
static void add_pixels_clamped_mmx(const DCTELEM *block, UINT8 *pixels, int line_size)
|
|
|
|
{
|
|
|
|
const DCTELEM *p;
|
|
|
|
UINT8 *pix;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
/* read the pixels */
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
i = 4;
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq (%2), %%mm0\n\t"
|
|
|
|
"movq 8(%2), %%mm1\n\t"
|
|
|
|
"movq 16(%2), %%mm2\n\t"
|
|
|
|
"movq 24(%2), %%mm3\n\t"
|
|
|
|
"movq %0, %%mm4\n\t"
|
|
|
|
"movq %1, %%mm6\n\t"
|
|
|
|
"movq %%mm4, %%mm5\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm5\n\t"
|
|
|
|
"paddsw %%mm4, %%mm0\n\t"
|
|
|
|
"paddsw %%mm5, %%mm1\n\t"
|
|
|
|
"movq %%mm6, %%mm5\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm6\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm5\n\t"
|
|
|
|
"paddsw %%mm6, %%mm2\n\t"
|
|
|
|
"paddsw %%mm5, %%mm3\n\t"
|
|
|
|
"packuswb %%mm1, %%mm0\n\t"
|
|
|
|
"packuswb %%mm3, %%mm2\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
"movq %%mm2, %1\n\t"
|
|
|
|
:"+m"(*pix), "+m"(*(pix+line_size))
|
|
|
|
:"r"(p)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size*2;
|
|
|
|
p += 16;
|
|
|
|
} while (--i);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void put_pixels_mmx(UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
int hh;
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
|
|
|
|
p = block;
|
|
|
|
pix = pixels; // 2s
|
|
|
|
#if 0
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"=m"(*p)
|
|
|
|
:"m"(*pix)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size;
|
|
|
|
} while (--h);
|
|
|
|
#else
|
|
|
|
// this optimized code is not very usefull
|
|
|
|
// the above loop is definitely faster
|
|
|
|
// at least on Celeron 500MHz
|
|
|
|
hh = h & 3;
|
|
|
|
while (hh) {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"=m"(*p)
|
|
|
|
:"m"(*pix)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size;
|
|
|
|
hh--;
|
|
|
|
}
|
|
|
|
hh=h>>2;
|
|
|
|
while (hh) {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq (%1), %%mm0 \n\t"
|
|
|
|
"movq (%1, %2), %%mm1 \n\t"
|
|
|
|
"movq (%1, %2, 2), %%mm2 \n\t"
|
|
|
|
"movq (%1, %3), %%mm3 \n\t"
|
|
|
|
"movq %%mm0, (%0) \n\t"
|
|
|
|
"movq %%mm1, (%0, %2) \n\t"
|
|
|
|
"movq %%mm2, (%0, %2, 2) \n\t"
|
|
|
|
"movq %%mm3, (%0, %3) \n\t"
|
|
|
|
::"r"(p), "r"(pix), "r"(line_size), "r"(line_size*3)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size*4;
|
|
|
|
p += line_size*4;
|
|
|
|
hh--;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
static void put_pixels_x2_mmx(UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
MOVQ_WONE(mm4);
|
|
|
|
JUMPALIGN();
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq 1%1, %%mm1\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"paddusw %%mm4, %%mm0\n\t"
|
|
|
|
"paddusw %%mm4, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"=m"(*p)
|
|
|
|
:"m"(*pix)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size; p += line_size;
|
|
|
|
} while (--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void put_pixels_y2_mmx(UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
MOVQ_WONE(mm4);
|
|
|
|
JUMPALIGN();
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %2, %%mm1\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"paddusw %%mm4, %%mm0\n\t"
|
|
|
|
"paddusw %%mm4, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"=m"(*p)
|
|
|
|
:"m"(*pix),
|
|
|
|
"m"(*(pix+line_size))
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size;
|
|
|
|
} while (--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void put_pixels_xy2_mmx(UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels; // 1s
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
MOVQ_WTWO(mm6);
|
|
|
|
JUMPALIGN();
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %2, %%mm1\n\t"
|
|
|
|
"movq 1%1, %%mm4\n\t"
|
|
|
|
"movq 1%2, %%mm5\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"movq %%mm4, %%mm1\n\t"
|
|
|
|
"movq %%mm5, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm5\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm5, %%mm4\n\t"
|
|
|
|
"paddusw %%mm3, %%mm1\n\t"
|
|
|
|
"paddusw %%mm6, %%mm4\n\t"
|
|
|
|
"paddusw %%mm6, %%mm1\n\t"
|
|
|
|
"paddusw %%mm4, %%mm0\n\t"
|
|
|
|
"paddusw %%mm1, %%mm2\n\t"
|
|
|
|
"psrlw $2, %%mm0\n\t"
|
|
|
|
"psrlw $2, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"=m"(*p)
|
|
|
|
:"m"(*pix),
|
|
|
|
"m"(*(pix+line_size))
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size;
|
|
|
|
} while(--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void put_no_rnd_pixels_x2_mmx( UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq 1%1, %%mm1\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"=m"(*p)
|
|
|
|
:"m"(*pix)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size;
|
|
|
|
} while (--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void put_no_rnd_pixels_y2_mmx( UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
JUMPALIGN();
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %2, %%mm1\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"=m"(*p)
|
|
|
|
:"m"(*pix),
|
|
|
|
"m"(*(pix+line_size))
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size;
|
|
|
|
} while(--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void put_no_rnd_pixels_xy2_mmx( UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
MOVQ_WONE(mm6);
|
|
|
|
JUMPALIGN();
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %2, %%mm1\n\t"
|
|
|
|
"movq 1%1, %%mm4\n\t"
|
|
|
|
"movq 1%2, %%mm5\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"movq %%mm4, %%mm1\n\t"
|
|
|
|
"movq %%mm5, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm5\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm5, %%mm4\n\t"
|
|
|
|
"paddusw %%mm3, %%mm1\n\t"
|
|
|
|
"paddusw %%mm6, %%mm4\n\t"
|
|
|
|
"paddusw %%mm6, %%mm1\n\t"
|
|
|
|
"paddusw %%mm4, %%mm0\n\t"
|
|
|
|
"paddusw %%mm1, %%mm2\n\t"
|
|
|
|
"psrlw $2, %%mm0\n\t"
|
|
|
|
"psrlw $2, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"=m"(*p)
|
|
|
|
:"m"(*pix),
|
|
|
|
"m"(*(pix+line_size))
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size;
|
|
|
|
} while(--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void avg_pixels_mmx(UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
MOVQ_WONE(mm6);
|
|
|
|
JUMPALIGN();
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %0, %%mm0\n\t"
|
|
|
|
"movq %1, %%mm1\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"paddusw %%mm6, %%mm0\n\t"
|
|
|
|
"paddusw %%mm6, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size;
|
|
|
|
}
|
|
|
|
while (--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void avg_pixels_x2_mmx( UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
MOVQ_WONE(mm6);
|
|
|
|
JUMPALIGN();
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm1\n\t"
|
|
|
|
"movq %0, %%mm0\n\t"
|
|
|
|
"movq 1%1, %%mm4\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"movq %%mm4, %%mm5\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm5\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"paddusw %%mm4, %%mm1\n\t"
|
|
|
|
"paddusw %%mm5, %%mm3\n\t"
|
|
|
|
"paddusw %%mm6, %%mm1\n\t"
|
|
|
|
"paddusw %%mm6, %%mm3\n\t"
|
|
|
|
"psrlw $1, %%mm1\n\t"
|
|
|
|
"psrlw $1, %%mm3\n\t"
|
|
|
|
"paddusw %%mm6, %%mm0\n\t"
|
|
|
|
"paddusw %%mm6, %%mm2\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size;
|
|
|
|
} while (--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void avg_pixels_y2_mmx( UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
MOVQ_WONE(mm6);
|
|
|
|
JUMPALIGN();
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm1\n\t"
|
|
|
|
"movq %0, %%mm0\n\t"
|
|
|
|
"movq %2, %%mm4\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"movq %%mm4, %%mm5\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm5\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"paddusw %%mm4, %%mm1\n\t"
|
|
|
|
"paddusw %%mm5, %%mm3\n\t"
|
|
|
|
"paddusw %%mm6, %%mm1\n\t"
|
|
|
|
"paddusw %%mm6, %%mm3\n\t"
|
|
|
|
"psrlw $1, %%mm1\n\t"
|
|
|
|
"psrlw $1, %%mm3\n\t"
|
|
|
|
"paddusw %%mm6, %%mm0\n\t"
|
|
|
|
"paddusw %%mm6, %%mm2\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix), "m"(*(pix+line_size))
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size ;
|
|
|
|
} while(--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void avg_pixels_xy2_mmx( UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
// this doesn't seem to be used offten - so
|
|
|
|
// the inside usage of mm_wone is not optimized
|
|
|
|
MOVQ_WTWO(mm6);
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %2, %%mm1\n\t"
|
|
|
|
"movq 1%1, %%mm4\n\t"
|
|
|
|
"movq 1%2, %%mm5\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"movq %%mm4, %%mm1\n\t"
|
|
|
|
"movq %%mm5, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm5\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm5, %%mm4\n\t"
|
|
|
|
"paddusw %%mm3, %%mm1\n\t"
|
|
|
|
"paddusw %%mm6, %%mm4\n\t"
|
|
|
|
"paddusw %%mm6, %%mm1\n\t"
|
|
|
|
"paddusw %%mm4, %%mm0\n\t"
|
|
|
|
"paddusw %%mm1, %%mm2\n\t"
|
|
|
|
"movq %3, %%mm5\n\t"
|
|
|
|
"psrlw $2, %%mm0\n\t"
|
|
|
|
"movq %0, %%mm1\n\t"
|
|
|
|
"psrlw $2, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"paddusw %%mm5, %%mm0\n\t"
|
|
|
|
"paddusw %%mm5, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix),
|
|
|
|
"m"(*(pix+line_size)), "m"(mm_wone)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size ;
|
|
|
|
} while(--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void avg_no_rnd_pixels_mmx( UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %0, %%mm1\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size ;
|
|
|
|
} while (--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void avg_no_rnd_pixels_x2_mmx( UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq 1%1, %%mm1\n\t"
|
|
|
|
"movq %0, %%mm4\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"movq %%mm4, %%mm5\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm5\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"paddusw %%mm4, %%mm0\n\t"
|
|
|
|
"paddusw %%mm5, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size;
|
|
|
|
} while (--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void avg_no_rnd_pixels_y2_mmx( UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %2, %%mm1\n\t"
|
|
|
|
"movq %0, %%mm4\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"movq %%mm4, %%mm5\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm5\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"paddusw %%mm4, %%mm0\n\t"
|
|
|
|
"paddusw %%mm5, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix), "m"(*(pix+line_size))
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size ;
|
|
|
|
} while(--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void avg_no_rnd_pixels_xy2_mmx( UINT8 *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
UINT8 *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
MOVQ_WONE(mm6);
|
|
|
|
JUMPALIGN();
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %2, %%mm1\n\t"
|
|
|
|
"movq 1%1, %%mm4\n\t"
|
|
|
|
"movq 1%2, %%mm5\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"movq %%mm4, %%mm1\n\t"
|
|
|
|
"movq %%mm5, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm5\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm5, %%mm4\n\t"
|
|
|
|
"paddusw %%mm3, %%mm1\n\t"
|
|
|
|
"paddusw %%mm6, %%mm4\n\t"
|
|
|
|
"paddusw %%mm6, %%mm1\n\t"
|
|
|
|
"paddusw %%mm4, %%mm0\n\t"
|
|
|
|
"paddusw %%mm1, %%mm2\n\t"
|
|
|
|
"movq %0, %%mm1\n\t"
|
|
|
|
"psrlw $2, %%mm0\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"psrlw $2, %%mm2\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm0\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"packuswb %%mm2, %%mm0\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix),
|
|
|
|
"m"(*(pix+line_size))
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += line_size;
|
|
|
|
} while(--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void sub_pixels_mmx( DCTELEM *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
DCTELEM *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %0, %%mm0\n\t"
|
|
|
|
"movq %1, %%mm2\n\t"
|
|
|
|
"movq 8%0, %%mm1\n\t"
|
|
|
|
"movq %%mm2, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"psubsw %%mm2, %%mm0\n\t"
|
|
|
|
"psubsw %%mm3, %%mm1\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
"movq %%mm1, 8%0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += 8;
|
|
|
|
} while (--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void sub_pixels_x2_mmx( DCTELEM *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
DCTELEM *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
MOVQ_WONE(mm6);
|
|
|
|
JUMPALIGN();
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %0, %%mm0\n\t"
|
|
|
|
"movq %1, %%mm2\n\t"
|
|
|
|
"movq 8%0, %%mm1\n\t"
|
|
|
|
"movq 1%1, %%mm4\n\t"
|
|
|
|
"movq %%mm2, %%mm3\n\t"
|
|
|
|
"movq %%mm4, %%mm5\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm5\n\t"
|
|
|
|
"paddusw %%mm4, %%mm2\n\t"
|
|
|
|
"paddusw %%mm5, %%mm3\n\t"
|
|
|
|
"paddusw %%mm6, %%mm2\n\t"
|
|
|
|
"paddusw %%mm6, %%mm3\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm3\n\t"
|
|
|
|
"psubsw %%mm2, %%mm0\n\t"
|
|
|
|
"psubsw %%mm3, %%mm1\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
"movq %%mm1, 8%0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix)
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += 8;
|
|
|
|
} while (--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void sub_pixels_y2_mmx( DCTELEM *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
DCTELEM *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
MOVQ_WONE(mm6);
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %0, %%mm0\n\t"
|
|
|
|
"movq %1, %%mm2\n\t"
|
|
|
|
"movq 8%0, %%mm1\n\t"
|
|
|
|
"movq %2, %%mm4\n\t"
|
|
|
|
"movq %%mm2, %%mm3\n\t"
|
|
|
|
"movq %%mm4, %%mm5\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm5\n\t"
|
|
|
|
"paddusw %%mm4, %%mm2\n\t"
|
|
|
|
"paddusw %%mm5, %%mm3\n\t"
|
|
|
|
"paddusw %%mm6, %%mm2\n\t"
|
|
|
|
"paddusw %%mm6, %%mm3\n\t"
|
|
|
|
"psrlw $1, %%mm2\n\t"
|
|
|
|
"psrlw $1, %%mm3\n\t"
|
|
|
|
"psubsw %%mm2, %%mm0\n\t"
|
|
|
|
"psubsw %%mm3, %%mm1\n\t"
|
|
|
|
"movq %%mm0, %0\n\t"
|
|
|
|
"movq %%mm1, 8%0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix), "m"(*(pix+line_size))
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += 8;
|
|
|
|
} while (--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void sub_pixels_xy2_mmx( DCTELEM *block, const UINT8 *pixels, int line_size, int h)
|
|
|
|
{
|
|
|
|
DCTELEM *p;
|
|
|
|
const UINT8 *pix;
|
|
|
|
p = block;
|
|
|
|
pix = pixels;
|
|
|
|
MOVQ_ZERO(mm7);
|
|
|
|
MOVQ_WTWO(mm6);
|
|
|
|
JUMPALIGN();
|
|
|
|
do {
|
|
|
|
__asm __volatile(
|
|
|
|
"movq %1, %%mm0\n\t"
|
|
|
|
"movq %2, %%mm1\n\t"
|
|
|
|
"movq 1%1, %%mm4\n\t"
|
|
|
|
"movq 1%2, %%mm5\n\t"
|
|
|
|
"movq %%mm0, %%mm2\n\t"
|
|
|
|
"movq %%mm1, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm0\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm2\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm1, %%mm0\n\t"
|
|
|
|
"paddusw %%mm3, %%mm2\n\t"
|
|
|
|
"movq %%mm4, %%mm1\n\t"
|
|
|
|
"movq %%mm5, %%mm3\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm4\n\t"
|
|
|
|
"punpcklbw %%mm7, %%mm5\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm1\n\t"
|
|
|
|
"punpckhbw %%mm7, %%mm3\n\t"
|
|
|
|
"paddusw %%mm5, %%mm4\n\t"
|
|
|
|
"paddusw %%mm3, %%mm1\n\t"
|
|
|
|
"paddusw %%mm6, %%mm4\n\t"
|
|
|
|
"paddusw %%mm6, %%mm1\n\t"
|
|
|
|
"paddusw %%mm4, %%mm0\n\t"
|
|
|
|
"paddusw %%mm1, %%mm2\n\t"
|
|
|
|
"movq %0, %%mm1\n\t"
|
|
|
|
"movq 8%0, %%mm3\n\t"
|
|
|
|
"psrlw $2, %%mm0\n\t"
|
|
|
|
"psrlw $2, %%mm2\n\t"
|
|
|
|
"psubsw %%mm0, %%mm1\n\t"
|
|
|
|
"psubsw %%mm2, %%mm3\n\t"
|
|
|
|
"movq %%mm1, %0\n\t"
|
|
|
|
"movq %%mm3, 8%0\n\t"
|
|
|
|
:"+m"(*p)
|
|
|
|
:"m"(*pix),
|
|
|
|
"m"(*(pix+line_size))
|
|
|
|
:"memory");
|
|
|
|
pix += line_size;
|
|
|
|
p += 8 ;
|
|
|
|
} while(--h);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void clear_blocks_mmx(DCTELEM *blocks)
|
|
|
|
{
|
|
|
|
asm volatile(
|
|
|
|
"pxor %%mm7, %%mm7 \n\t"
|
|
|
|
"movl $-128*6, %%eax \n\t"
|
|
|
|
"1: \n\t"
|
|
|
|
"movq %%mm7, (%0, %%eax) \n\t"
|
|
|
|
"movq %%mm7, 8(%0, %%eax) \n\t"
|
|
|
|
"movq %%mm7, 16(%0, %%eax) \n\t"
|
|
|
|
"movq %%mm7, 24(%0, %%eax) \n\t"
|
|
|
|
"addl $32, %%eax \n\t"
|
|
|
|
" js 1b \n\t"
|
|
|
|
: : "r" (((int)blocks)+128*6)
|
|
|
|
: "%eax"
|
|
|
|
);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void just_return() { return; }
|
|
|
|
|
|
|
|
void dsputil_init_mmx(void)
|
|
|
|
{
|
|
|
|
mm_flags = mm_support();
|
|
|
|
#if 1
|
|
|
|
printf("libavcodec: CPU flags:");
|
|
|
|
if (mm_flags & MM_MMX)
|
|
|
|
printf(" mmx");
|
|
|
|
if (mm_flags & MM_MMXEXT)
|
|
|
|
printf(" mmxext");
|
|
|
|
if (mm_flags & MM_3DNOW)
|
|
|
|
printf(" 3dnow");
|
|
|
|
if (mm_flags & MM_SSE)
|
|
|
|
printf(" sse");
|
|
|
|
if (mm_flags & MM_SSE2)
|
|
|
|
printf(" sse2");
|
|
|
|
printf("\n");
|
|
|
|
#endif
|
|
|
|
|
|
|
|
if (mm_flags & MM_MMX) {
|
|
|
|
get_pixels = get_pixels_mmx;
|
|
|
|
diff_pixels = diff_pixels_mmx;
|
|
|
|
put_pixels_clamped = put_pixels_clamped_mmx;
|
|
|
|
add_pixels_clamped = add_pixels_clamped_mmx;
|
|
|
|
clear_blocks= clear_blocks_mmx;
|
|
|
|
|
|
|
|
pix_abs16x16 = pix_abs16x16_mmx;
|
|
|
|
pix_abs16x16_x2 = pix_abs16x16_x2_mmx;
|
|
|
|
pix_abs16x16_y2 = pix_abs16x16_y2_mmx;
|
|
|
|
pix_abs16x16_xy2 = pix_abs16x16_xy2_mmx;
|
|
|
|
pix_abs8x8 = pix_abs8x8_mmx;
|
|
|
|
pix_abs8x8_x2 = pix_abs8x8_x2_mmx;
|
|
|
|
pix_abs8x8_y2 = pix_abs8x8_y2_mmx;
|
|
|
|
pix_abs8x8_xy2= pix_abs8x8_xy2_mmx;
|
|
|
|
av_fdct = fdct_mmx;
|
|
|
|
|
|
|
|
put_pixels_tab[0] = put_pixels_mmx;
|
|
|
|
put_pixels_tab[1] = put_pixels_x2_mmx;
|
|
|
|
put_pixels_tab[2] = put_pixels_y2_mmx;
|
|
|
|
put_pixels_tab[3] = put_pixels_xy2_mmx;
|
|
|
|
|
|
|
|
put_no_rnd_pixels_tab[0] = put_pixels_mmx;
|
|
|
|
put_no_rnd_pixels_tab[1] = put_no_rnd_pixels_x2_mmx;
|
|
|
|
put_no_rnd_pixels_tab[2] = put_no_rnd_pixels_y2_mmx;
|
|
|
|
put_no_rnd_pixels_tab[3] = put_no_rnd_pixels_xy2_mmx;
|
|
|
|
|
|
|
|
avg_pixels_tab[0] = avg_pixels_mmx;
|
|
|
|
avg_pixels_tab[1] = avg_pixels_x2_mmx;
|
|
|
|
avg_pixels_tab[2] = avg_pixels_y2_mmx;
|
|
|
|
avg_pixels_tab[3] = avg_pixels_xy2_mmx;
|
|
|
|
|
|
|
|
avg_no_rnd_pixels_tab[0] = avg_no_rnd_pixels_mmx;
|
|
|
|
avg_no_rnd_pixels_tab[1] = avg_no_rnd_pixels_x2_mmx;
|
|
|
|
avg_no_rnd_pixels_tab[2] = avg_no_rnd_pixels_y2_mmx;
|
|
|
|
avg_no_rnd_pixels_tab[3] = avg_no_rnd_pixels_xy2_mmx;
|
|
|
|
|
|
|
|
sub_pixels_tab[0] = sub_pixels_mmx;
|
|
|
|
sub_pixels_tab[1] = sub_pixels_x2_mmx;
|
|
|
|
sub_pixels_tab[2] = sub_pixels_y2_mmx;
|
|
|
|
sub_pixels_tab[3] = sub_pixels_xy2_mmx;
|
|
|
|
|
|
|
|
if (mm_flags & MM_MMXEXT) {
|
|
|
|
pix_abs16x16 = pix_abs16x16_mmx2;
|
|
|
|
pix_abs16x16_x2 = pix_abs16x16_x2_mmx2;
|
|
|
|
pix_abs16x16_y2 = pix_abs16x16_y2_mmx2;
|
|
|
|
pix_abs16x16_xy2= pix_abs16x16_xy2_mmx2;
|
|
|
|
|
|
|
|
pix_abs8x8 = pix_abs8x8_mmx2;
|
|
|
|
pix_abs8x8_x2 = pix_abs8x8_x2_mmx2;
|
|
|
|
pix_abs8x8_y2 = pix_abs8x8_y2_mmx2;
|
|
|
|
pix_abs8x8_xy2= pix_abs8x8_xy2_mmx2;
|
|
|
|
|
|
|
|
put_pixels_tab[1] = put_pixels_x2_sse;
|
|
|
|
put_pixels_tab[2] = put_pixels_y2_sse;
|
|
|
|
|
|
|
|
avg_pixels_tab[0] = avg_pixels_sse;
|
|
|
|
avg_pixels_tab[1] = avg_pixels_x2_sse;
|
|
|
|
avg_pixels_tab[2] = avg_pixels_y2_sse;
|
|
|
|
avg_pixels_tab[3] = avg_pixels_xy2_sse;
|
|
|
|
|
|
|
|
sub_pixels_tab[1] = sub_pixels_x2_sse;
|
|
|
|
sub_pixels_tab[2] = sub_pixels_y2_sse;
|
|
|
|
} else if (mm_flags & MM_3DNOW) {
|
|
|
|
put_pixels_tab[1] = put_pixels_x2_3dnow;
|
|
|
|
put_pixels_tab[2] = put_pixels_y2_3dnow;
|
|
|
|
|
|
|
|
avg_pixels_tab[0] = avg_pixels_3dnow;
|
|
|
|
avg_pixels_tab[1] = avg_pixels_x2_3dnow;
|
|
|
|
avg_pixels_tab[2] = avg_pixels_y2_3dnow;
|
|
|
|
avg_pixels_tab[3] = avg_pixels_xy2_3dnow;
|
|
|
|
|
|
|
|
sub_pixels_tab[1] = sub_pixels_x2_3dnow;
|
|
|
|
sub_pixels_tab[2] = sub_pixels_y2_3dnow;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* idct */
|
|
|
|
if (mm_flags & MM_MMXEXT) {
|
|
|
|
ff_idct = ff_mmxext_idct;
|
|
|
|
} else {
|
|
|
|
ff_idct = ff_mmx_idct;
|
|
|
|
}
|
|
|
|
#ifdef SIMPLE_IDCT
|
|
|
|
// ff_idct = simple_idct;
|
|
|
|
ff_idct = simple_idct_mmx;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
#if 0
|
|
|
|
// for speed testing
|
|
|
|
get_pixels = just_return;
|
|
|
|
put_pixels_clamped = just_return;
|
|
|
|
add_pixels_clamped = just_return;
|
|
|
|
|
|
|
|
pix_abs16x16 = just_return;
|
|
|
|
pix_abs16x16_x2 = just_return;
|
|
|
|
pix_abs16x16_y2 = just_return;
|
|
|
|
pix_abs16x16_xy2 = just_return;
|
|
|
|
|
|
|
|
put_pixels_tab[0] = just_return;
|
|
|
|
put_pixels_tab[1] = just_return;
|
|
|
|
put_pixels_tab[2] = just_return;
|
|
|
|
put_pixels_tab[3] = just_return;
|
|
|
|
|
|
|
|
put_no_rnd_pixels_tab[0] = just_return;
|
|
|
|
put_no_rnd_pixels_tab[1] = just_return;
|
|
|
|
put_no_rnd_pixels_tab[2] = just_return;
|
|
|
|
put_no_rnd_pixels_tab[3] = just_return;
|
|
|
|
|
|
|
|
avg_pixels_tab[0] = just_return;
|
|
|
|
avg_pixels_tab[1] = just_return;
|
|
|
|
avg_pixels_tab[2] = just_return;
|
|
|
|
avg_pixels_tab[3] = just_return;
|
|
|
|
|
|
|
|
avg_no_rnd_pixels_tab[0] = just_return;
|
|
|
|
avg_no_rnd_pixels_tab[1] = just_return;
|
|
|
|
avg_no_rnd_pixels_tab[2] = just_return;
|
|
|
|
avg_no_rnd_pixels_tab[3] = just_return;
|
|
|
|
|
|
|
|
sub_pixels_tab[0] = just_return;
|
|
|
|
sub_pixels_tab[1] = just_return;
|
|
|
|
sub_pixels_tab[2] = just_return;
|
|
|
|
sub_pixels_tab[3] = just_return;
|
|
|
|
|
|
|
|
//av_fdct = just_return;
|
|
|
|
//ff_idct = just_return;
|
|
|
|
#endif
|
|
|
|
}
|