You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
257 lines
12 KiB
257 lines
12 KiB
|
|
#include "ditherMMX.h"
|
|
|
|
#include <iostream>
|
|
|
|
using namespace std;
|
|
|
|
#ifndef INTEL
|
|
// nothing
|
|
void ditherBlock(unsigned char *lum, unsigned char *cr, unsigned char *cb,
|
|
unsigned char *out,
|
|
int cols, int rows, int screen_width) {
|
|
printf("call to ditherBlock. this should never happen\n");
|
|
printf("check mmx detection routine.\n");
|
|
exit(0);
|
|
}
|
|
#else
|
|
|
|
|
|
static long long MMX16_0 = 0L;
|
|
static unsigned long MMX16_10w[] = {0x00100010, 0x00100010};
|
|
static unsigned long MMX16_80w[] = {0x00800080, 0x00800080};
|
|
static unsigned long MMX16_00FFw[] = {0x00ff00ff, 0x00ff00ff};
|
|
static unsigned short MMX16_Ublucoeff[] = {0x81, 0x81, 0x81, 0x81};
|
|
static unsigned short MMX16_Vredcoeff[] = {0x66, 0x66, 0x66, 0x66};
|
|
static unsigned short MMX16_Ugrncoeff[] = {0xffe8, 0xffe8, 0xffe8, 0xffe8};
|
|
static unsigned short MMX16_Vgrncoeff[] = {0xffcd, 0xffcd, 0xffcd, 0xffcd};
|
|
static unsigned short MMX16_Ycoeff[] = {0x4a, 0x4a, 0x4a, 0x4a};
|
|
static unsigned short MMX16_redmask[] = {0xf800, 0xf800, 0xf800, 0xf800};
|
|
static unsigned short MMX16_grnmask[] = {0x7e0, 0x7e0, 0x7e0, 0x7e0};
|
|
|
|
void dummy_dithermmx16() {
|
|
cout << "MMX16_0"<<MMX16_0<<endl;
|
|
cout << "MMX16_10w:"<<MMX16_10w<<endl;
|
|
cout << "MMX16_80w:"<<MMX16_80w<<endl;
|
|
cout << "MMX16_Ublucoeff:"<<MMX16_Ublucoeff<<endl;
|
|
cout << "MMX16_Vredcoeff:"<<MMX16_Vredcoeff<<endl;
|
|
cout << "MMX16_Ugrncoeff:"<<MMX16_Ugrncoeff<<endl;
|
|
cout << "MMX16_Vgrncoeff:"<<MMX16_Vgrncoeff<<endl;
|
|
cout << "MMX16_Ycoeff:"<<MMX16_Ycoeff<<endl;
|
|
cout << "MMX16_redmask:"<<MMX16_redmask<<endl;
|
|
cout << "MMX16_grnmask:"<<MMX16_grnmask<<endl;
|
|
cout << "MMX16_00FFw:"<<MMX16_00FFw<<endl;
|
|
}
|
|
|
|
|
|
void ditherBlock(unsigned char *lum,
|
|
unsigned char *cr,
|
|
unsigned char *cb,
|
|
unsigned char *out,
|
|
int rows,
|
|
int cols,
|
|
int mod) {
|
|
|
|
unsigned short *row1;
|
|
unsigned short *row2;
|
|
row1 = (unsigned short* )out; // 16 bit target
|
|
|
|
unsigned char* end = lum +cols*rows; // Pointer to the end
|
|
int x=cols;
|
|
row2=row1+mod+cols; // start of second row
|
|
mod=2*cols+4*mod; // increment for row1 in byte
|
|
|
|
// buffer for asm function
|
|
int buf[6];
|
|
buf[0]=(int)(lum+cols); // lum2 pointer
|
|
buf[1]=(int)end;
|
|
buf[2]=x;
|
|
buf[3]=mod;
|
|
buf[4]=0; //tmp0;
|
|
buf[5]=cols;
|
|
|
|
|
|
|
|
__asm__ __volatile__(
|
|
".align 32\n"
|
|
"1:\n"
|
|
"movd (%1), %%mm0\n" // 4 Cb 0 0 0 0 u3 u2 u1 u0
|
|
"pxor %%mm7, %%mm7\n"
|
|
"movd (%0), %%mm1\n" // 4 Cr 0 0 0 0 v3 v2 v1 v0
|
|
"punpcklbw %%mm7, %%mm0\n" // 4 W cb 0 u3 0 u2 0 u1 0 u0
|
|
"punpcklbw %%mm7, %%mm1\n" // 4 W cr 0 v3 0 v2 0 v1 0 v0
|
|
"psubw MMX16_80w, %%mm0\n"
|
|
"psubw MMX16_80w, %%mm1\n"
|
|
"movq %%mm0, %%mm2\n" // Cb 0 u3 0 u2 0 u1 0 u0
|
|
"movq %%mm1, %%mm3\n" // Cr
|
|
"pmullw MMX16_Ugrncoeff, %%mm2\n" // Cb2green 0 R3 0 R2 0 R1 0 R0
|
|
"movq (%2), %%mm6\n" // L1 l7 L6 L5 L4 L3 L2 L1 L0
|
|
"pmullw MMX16_Ublucoeff, %%mm0\n" // Cb2blue
|
|
"pand MMX16_00FFw, %%mm6\n" // L1 00 L6 00 L4 00 L2 00 L0
|
|
"pmullw MMX16_Vgrncoeff, %%mm3\n" // Cr2green
|
|
"movq (%2), %%mm7\n" // L2
|
|
"pmullw MMX16_Vredcoeff, %%mm1\n" // Cr2red
|
|
// "psubw MMX16_10w, %%mm6\n"
|
|
"psrlw $8, %%mm7\n" // L2 00 L7 00 L5 00 L3 00 L1
|
|
"pmullw MMX16_Ycoeff, %%mm6\n" // lum1
|
|
// "psubw MMX16_10w, %%mm7\n" // L2
|
|
"paddw %%mm3, %%mm2\n" // Cb2green + Cr2green == green
|
|
"pmullw MMX16_Ycoeff, %%mm7\n" // lum2
|
|
|
|
"movq %%mm6, %%mm4\n" // lum1
|
|
"paddw %%mm0, %%mm6\n" // lum1 +blue 00 B6 00 B4 00 B2 00 B0
|
|
"movq %%mm4, %%mm5\n" // lum1
|
|
"paddw %%mm1, %%mm4\n" // lum1 +red 00 R6 00 R4 00 R2 00 R0
|
|
"paddw %%mm2, %%mm5\n" // lum1 +green 00 G6 00 G4 00 G2 00 G0
|
|
"psraw $6, %%mm4\n" // R1 0 .. 64
|
|
"movq %%mm7, %%mm3\n" // lum2 00 L7 00 L5 00 L3 00 L1
|
|
"psraw $6, %%mm5\n" // G1 - .. +
|
|
"paddw %%mm0, %%mm7\n" // Lum2 +blue 00 B7 00 B5 00 B3 00 B1
|
|
"psraw $6, %%mm6\n" // B1 0 .. 64
|
|
"packuswb %%mm4, %%mm4\n" // R1 R1
|
|
"packuswb %%mm5, %%mm5\n" // G1 G1
|
|
"packuswb %%mm6, %%mm6\n" // B1 B1
|
|
"punpcklbw %%mm4, %%mm4\n"
|
|
"punpcklbw %%mm5, %%mm5\n"
|
|
|
|
"pand MMX16_redmask, %%mm4\n"
|
|
"psllw $3, %%mm5\n" // GREEN 1
|
|
"punpcklbw %%mm6, %%mm6\n"
|
|
"pand MMX16_grnmask, %%mm5\n"
|
|
"pand MMX16_redmask, %%mm6\n"
|
|
"por %%mm5, %%mm4\n" //
|
|
"psrlw $11, %%mm6\n" // BLUE 1
|
|
"movq %%mm3, %%mm5\n" // lum2
|
|
"paddw %%mm1, %%mm3\n" // lum2 +red 00 R7 00 R5 00 R3 00 R1
|
|
"paddw %%mm2, %%mm5\n" // lum2 +green 00 G7 00 G5 00 G3 00 G1
|
|
"psraw $6, %%mm3\n" // R2
|
|
"por %%mm6, %%mm4\n" // MM4
|
|
"psraw $6, %%mm5\n" // G2
|
|
|
|
"movl %2,16%5\n" // store register in tmp0
|
|
"movl %5,%2\n" // lum2->register
|
|
"movq (%2),%%mm6\n" // 0 0 0 0 L3 L2 L1 L0 (load lum2)
|
|
|
|
|
|
//"movq (%2, %5), %%mm6\n" // L3 load lum2
|
|
"psraw $6, %%mm7\n"
|
|
"packuswb %%mm3, %%mm3\n"
|
|
"packuswb %%mm5, %%mm5\n"
|
|
"packuswb %%mm7, %%mm7\n"
|
|
"pand MMX16_00FFw, %%mm6\n" // L3
|
|
"punpcklbw %%mm3, %%mm3\n"
|
|
// "psubw MMX16_10w, %%mm6\n" // L3
|
|
"punpcklbw %%mm5, %%mm5\n"
|
|
"pmullw MMX16_Ycoeff, %%mm6\n" // lum3
|
|
"punpcklbw %%mm7, %%mm7\n"
|
|
"psllw $3, %%mm5\n" // GREEN 2
|
|
"pand MMX16_redmask, %%mm7\n"
|
|
"pand MMX16_redmask, %%mm3\n"
|
|
"psrlw $11, %%mm7\n" // BLUE 2
|
|
"pand MMX16_grnmask, %%mm5\n"
|
|
"por %%mm7, %%mm3\n"
|
|
|
|
"movq (%2), %%mm7\n" // L4 load lum2
|
|
"movl 16%5,%2\n" // tmp0->register
|
|
|
|
"por %%mm5, %%mm3\n" //
|
|
"psrlw $8, %%mm7\n" // L4
|
|
"movq %%mm4, %%mm5\n"
|
|
// "psubw MMX16_10w, %%mm7\n" // L4
|
|
"punpcklwd %%mm3, %%mm4\n"
|
|
"pmullw MMX16_Ycoeff, %%mm7\n" // lum4
|
|
"punpckhwd %%mm3, %%mm5\n"
|
|
|
|
"movq %%mm4, (%3)\n" // write row1
|
|
"movq %%mm5, 8(%3)\n" // write row1
|
|
|
|
"movq %%mm6, %%mm4\n" // Lum3
|
|
"paddw %%mm0, %%mm6\n" // Lum3 +blue
|
|
|
|
"movq %%mm4, %%mm5\n" // Lum3
|
|
"paddw %%mm1, %%mm4\n" // Lum3 +red
|
|
"paddw %%mm2, %%mm5\n" // Lum3 +green
|
|
"psraw $6, %%mm4\n"
|
|
"movq %%mm7, %%mm3\n" // Lum4
|
|
"psraw $6, %%mm5\n"
|
|
"paddw %%mm0, %%mm7\n" // Lum4 +blue
|
|
"psraw $6, %%mm6\n" // Lum3 +blue
|
|
"movq %%mm3, %%mm0\n" // Lum4
|
|
"packuswb %%mm4, %%mm4\n"
|
|
"paddw %%mm1, %%mm3\n" // Lum4 +red
|
|
"packuswb %%mm5, %%mm5\n"
|
|
"paddw %%mm2, %%mm0\n" // Lum4 +green
|
|
"packuswb %%mm6, %%mm6\n"
|
|
"punpcklbw %%mm4, %%mm4\n"
|
|
"punpcklbw %%mm5, %%mm5\n"
|
|
"punpcklbw %%mm6, %%mm6\n"
|
|
"psllw $3, %%mm5\n" // GREEN 3
|
|
"pand MMX16_redmask, %%mm4\n"
|
|
"psraw $6, %%mm3\n" // psr 6
|
|
"psraw $6, %%mm0\n"
|
|
"pand MMX16_redmask, %%mm6\n" // BLUE
|
|
"pand MMX16_grnmask, %%mm5\n"
|
|
"psrlw $11, %%mm6\n" // BLUE 3
|
|
"por %%mm5, %%mm4\n"
|
|
"psraw $6, %%mm7\n"
|
|
"por %%mm6, %%mm4\n"
|
|
"packuswb %%mm3, %%mm3\n"
|
|
"packuswb %%mm0, %%mm0\n"
|
|
"packuswb %%mm7, %%mm7\n"
|
|
"punpcklbw %%mm3, %%mm3\n"
|
|
"punpcklbw %%mm0, %%mm0\n"
|
|
"punpcklbw %%mm7, %%mm7\n"
|
|
"pand MMX16_redmask, %%mm3\n"
|
|
"pand MMX16_redmask, %%mm7\n" // BLUE
|
|
"psllw $3, %%mm0\n" // GREEN 4
|
|
"psrlw $11, %%mm7\n"
|
|
"pand MMX16_grnmask, %%mm0\n"
|
|
"por %%mm7, %%mm3\n"
|
|
"por %%mm0, %%mm3\n"
|
|
|
|
"movq %%mm4, %%mm5\n"
|
|
|
|
"punpcklwd %%mm3, %%mm4\n"
|
|
"punpckhwd %%mm3, %%mm5\n"
|
|
|
|
"movq %%mm4, (%4)\n"
|
|
"movq %%mm5, 8(%4)\n"
|
|
|
|
"subl $8, 8%5\n" // x-=8
|
|
"addl $8, %5\n" // lum2+8
|
|
"addl $8, %2\n"
|
|
"addl $4, %0\n"
|
|
"addl $4, %1\n"
|
|
"cmpl $0, 8%5\n"
|
|
"leal 16(%3), %3\n"
|
|
"leal 16(%4), %4\n" // row2+16
|
|
|
|
|
|
"jne 1b\n"
|
|
"addl 20%5, %2\n" // lum += cols
|
|
|
|
"movl %2,16%5\n" // store register in tmp0
|
|
"movl 20%5,%2\n" // cols->register
|
|
|
|
"addl %2, %5\n" // lum2 += cols
|
|
"addl 12%5, %3\n" // row1+= mod
|
|
"addl 12%5, %4\n" // row2+= mod
|
|
"movl %2, 8%5\n" // x=cols
|
|
"movl 16%5,%2\n" // store tmp0 in register
|
|
|
|
"cmpl 4%5, %2\n"
|
|
"jl 1b\n"
|
|
|
|
:
|
|
:"r" (cr), "r"(cb),"r"(lum),
|
|
"r"(row1),"r"(row2),"m"(buf[0])
|
|
|
|
);
|
|
__asm__ (
|
|
"emms\n"
|
|
);
|
|
|
|
}
|
|
|
|
#endif
|