src/video/SDL_yuv_mmx.c
author Ryan C. Gordon <icculus@icculus.org>
Fri, 06 Jan 2006 13:20:10 +0000
changeset 1234 73676c1f56ee
parent 1148 63fb2da89a4b
child 1312 c9b51268668f
permissions -rw-r--r--
For sanity's sake, removed the '&' when passing copy_row array to asm.
slouken@0
     1
/*
slouken@0
     2
    SDL - Simple DirectMedia Layer
slouken@769
     3
    Copyright (C) 1997-2004 Sam Lantinga
slouken@0
     4
slouken@0
     5
    This library is free software; you can redistribute it and/or
slouken@0
     6
    modify it under the terms of the GNU Library General Public
slouken@0
     7
    License as published by the Free Software Foundation; either
slouken@0
     8
    version 2 of the License, or (at your option) any later version.
slouken@0
     9
slouken@0
    10
    This library is distributed in the hope that it will be useful,
slouken@0
    11
    but WITHOUT ANY WARRANTY; without even the implied warranty of
slouken@0
    12
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
slouken@0
    13
    Library General Public License for more details.
slouken@0
    14
slouken@0
    15
    You should have received a copy of the GNU Library General Public
slouken@0
    16
    License along with this library; if not, write to the Free
slouken@0
    17
    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
slouken@0
    18
slouken@0
    19
    Sam Lantinga
slouken@252
    20
    slouken@libsdl.org
slouken@0
    21
*/
slouken@0
    22
slouken@0
    23
#ifdef SAVE_RCSID
slouken@0
    24
static char rcsid =
slouken@0
    25
 "@(#) $Id$";
slouken@0
    26
#endif
slouken@0
    27
slouken@0
    28
slouken@0
    29
#if defined(i386) && defined(__GNUC__) && defined(USE_ASMBLIT)
slouken@0
    30
slouken@0
    31
#include "SDL_types.h"
slouken@0
    32
icculus@1148
    33
#define ASM_ARRAY(x) x[] __asm__("_" #x) __attribute__((used))
icculus@1148
    34
 
icculus@1148
    35
static unsigned int  ASM_ARRAY(MMX_0080w)    = {0x00800080, 0x00800080};
icculus@1148
    36
static unsigned int  ASM_ARRAY(MMX_00FFw)    = {0x00ff00ff, 0x00ff00ff};
icculus@1148
    37
static unsigned int  ASM_ARRAY(MMX_FF00w)    = {0xff00ff00, 0xff00ff00};
slouken@0
    38
icculus@1148
    39
static unsigned short ASM_ARRAY(MMX_Ycoeff)  = {0x004a, 0x004a, 0x004a, 0x004a};
slouken@0
    40
icculus@1148
    41
static unsigned short ASM_ARRAY(MMX_UbluRGB) = {0x0072, 0x0072, 0x0072, 0x0072};
icculus@1148
    42
static unsigned short ASM_ARRAY(MMX_VredRGB) = {0x0059, 0x0059, 0x0059, 0x0059};
icculus@1148
    43
static unsigned short ASM_ARRAY(MMX_UgrnRGB) = {0xffea, 0xffea, 0xffea, 0xffea};
icculus@1148
    44
static unsigned short ASM_ARRAY(MMX_VgrnRGB) = {0xffd2, 0xffd2, 0xffd2, 0xffd2};
slouken@0
    45
icculus@1148
    46
static unsigned short ASM_ARRAY(MMX_Ublu5x5) = {0x0081, 0x0081, 0x0081, 0x0081};
icculus@1148
    47
static unsigned short ASM_ARRAY(MMX_Vred5x5) = {0x0066, 0x0066, 0x0066, 0x0066};
icculus@1148
    48
static unsigned short ASM_ARRAY(MMX_Ugrn555) = {0xffe7, 0xffe7, 0xffe7, 0xffe7};
icculus@1148
    49
static unsigned short ASM_ARRAY(MMX_Vgrn555) = {0xffcc, 0xffcc, 0xffcc, 0xffcc};
icculus@1148
    50
static unsigned short ASM_ARRAY(MMX_Ugrn565) = {0xffe8, 0xffe8, 0xffe8, 0xffe8};
icculus@1148
    51
static unsigned short ASM_ARRAY(MMX_Vgrn565) = {0xffcd, 0xffcd, 0xffcd, 0xffcd};
slouken@0
    52
icculus@1148
    53
static unsigned short ASM_ARRAY(MMX_red555)  = {0x7c00, 0x7c00, 0x7c00, 0x7c00};
icculus@1148
    54
static unsigned short ASM_ARRAY(MMX_red565)  = {0xf800, 0xf800, 0xf800, 0xf800};
icculus@1148
    55
static unsigned short ASM_ARRAY(MMX_grn555)  = {0x03e0, 0x03e0, 0x03e0, 0x03e0};
icculus@1148
    56
static unsigned short ASM_ARRAY(MMX_grn565)  = {0x07e0, 0x07e0, 0x07e0, 0x07e0};
icculus@1148
    57
static unsigned short ASM_ARRAY(MMX_blu5x5)  = {0x001f, 0x001f, 0x001f, 0x001f};
slouken@0
    58
slouken@0
    59
/**
slouken@0
    60
   This MMX assembler is my first assembler/MMX program ever.
slouken@0
    61
   Thus it maybe buggy.
slouken@0
    62
   Send patches to:
slouken@0
    63
   mvogt@rhrk.uni-kl.de
slouken@0
    64
slouken@0
    65
   After it worked fine I have "obfuscated" the code a bit to have
slouken@0
    66
   more parallism in the MMX units. This means I moved
slouken@0
    67
   initilisation around and delayed other instruction.
slouken@0
    68
   Performance measurement did not show that this brought any advantage
slouken@0
    69
   but in theory it _should_ be faster this way.
slouken@0
    70
slouken@0
    71
   The overall performanve gain to the C based dither was 30%-40%.
slouken@0
    72
   The MMX routine calculates 256bit=8RGB values in each cycle
slouken@0
    73
   (4 for row1 & 4 for row2)
slouken@0
    74
slouken@0
    75
   The red/green/blue.. coefficents are taken from the mpeg_play 
slouken@0
    76
   player. They look nice, but I dont know if you can have
slouken@0
    77
   better values, to avoid integer rounding errors.
slouken@0
    78
   
slouken@0
    79
slouken@0
    80
   IMPORTANT:
slouken@0
    81
   ==========
slouken@0
    82
slouken@0
    83
   It is a requirement that the cr/cb/lum are 8 byte aligned and
slouken@0
    84
   the out are 16byte aligned or you will/may get segfaults
slouken@0
    85
slouken@0
    86
*/
slouken@0
    87
slouken@0
    88
void ColorRGBDitherYV12MMX1X( int *colortab, Uint32 *rgb_2_pix,
slouken@0
    89
                              unsigned char *lum, unsigned char *cr,
slouken@0
    90
                              unsigned char *cb, unsigned char *out,
slouken@0
    91
                              int rows, int cols, int mod )
slouken@0
    92
{
slouken@0
    93
    Uint32 *row1;
slouken@0
    94
    Uint32 *row2;
slouken@0
    95
slouken@0
    96
    unsigned char* y = lum +cols*rows;    // Pointer to the end
slouken@0
    97
    int x=0;
slouken@0
    98
    row1 = (Uint32 *)out;                 // 32 bit target
slouken@0
    99
    row2 = (Uint32 *)out+cols+mod;        // start of second row 
slouken@0
   100
    mod = (mod+cols+mod)*4;               // increment for row1 in byte
slouken@0
   101
slouken@0
   102
    __asm__ __volatile__ (
slouken@0
   103
/* We don't really care about PIC - the code should be rewritten to use
slouken@0
   104
   relative addressing for the static tables, so right now we take the
slouken@0
   105
   COW hit on the pages this code resides. Big deal.
slouken@0
   106
   This spill is just to reduce register pressure in the PIC case. */
slouken@0
   107
		 "pushl %%ebx\n"
slouken@0
   108
		 "movl %0, %%ebx\n"
slouken@0
   109
slouken@0
   110
	         ".align 8\n"
slouken@0
   111
		 "1:\n"
slouken@0
   112
		
slouken@0
   113
		 // create Cr (result in mm1)
slouken@0
   114
		 "movd (%%ebx), %%mm1\n"   //         0  0  0  0  v3 v2 v1 v0
slouken@0
   115
		 "pxor %%mm7,%%mm7\n"      //         00 00 00 00 00 00 00 00
slouken@0
   116
		 "movd (%2), %%mm2\n"           //    0  0  0  0 l3 l2 l1 l0
slouken@0
   117
		 "punpcklbw %%mm7,%%mm1\n" //         0  v3 0  v2 00 v1 00 v0
slouken@0
   118
		 "punpckldq %%mm1,%%mm1\n" //         00 v1 00 v0 00 v1 00 v0
slouken@1038
   119
		 "psubw _MMX_0080w,%%mm1\n"  // mm1-128:r1 r1 r0 r0 r1 r1 r0 r0 
slouken@0
   120
slouken@0
   121
		 // create Cr_g (result in mm0)
slouken@0
   122
		 "movq %%mm1,%%mm0\n"           // r1 r1 r0 r0 r1 r1 r0 r0
slouken@1038
   123
		 "pmullw _MMX_VgrnRGB,%%mm0\n"// red*-46dec=0.7136*64
slouken@1038
   124
		 "pmullw _MMX_VredRGB,%%mm1\n"// red*89dec=1.4013*64
slouken@0
   125
		 "psraw  $6, %%mm0\n"           // red=red/64
slouken@0
   126
		 "psraw  $6, %%mm1\n"           // red=red/64
slouken@0
   127
		 
slouken@0
   128
		 // create L1 L2 (result in mm2,mm4)
slouken@0
   129
		 // L2=lum+cols
slouken@0
   130
		 "movq (%2,%4),%%mm3\n"         //    0  0  0  0 L3 L2 L1 L0
slouken@0
   131
		 "punpckldq %%mm3,%%mm2\n"      //   L3 L2 L1 L0 l3 l2 l1 l0
slouken@0
   132
		 "movq %%mm2,%%mm4\n"           //   L3 L2 L1 L0 l3 l2 l1 l0
slouken@1038
   133
		 "pand _MMX_FF00w,%%mm2\n"      //   L3 0  L1  0 l3  0 l1  0
slouken@1038
   134
		 "pand _MMX_00FFw,%%mm4\n"      //   0  L2  0 L0  0 l2  0 l0
slouken@0
   135
		 "psrlw $8,%%mm2\n"             //   0  L3  0 L1  0 l3  0 l1
slouken@0
   136
slouken@0
   137
		 // create R (result in mm6)
slouken@0
   138
		 "movq %%mm2,%%mm5\n"           //   0 L3  0 L1  0 l3  0 l1
slouken@0
   139
		 "movq %%mm4,%%mm6\n"           //   0 L2  0 L0  0 l2  0 l0
slouken@0
   140
		 "paddsw  %%mm1, %%mm5\n"       // lum1+red:x R3 x R1 x r3 x r1
slouken@0
   141
		 "paddsw  %%mm1, %%mm6\n"       // lum1+red:x R2 x R0 x r2 x r0
slouken@0
   142
		 "packuswb %%mm5,%%mm5\n"       //  R3 R1 r3 r1 R3 R1 r3 r1
slouken@0
   143
		 "packuswb %%mm6,%%mm6\n"       //  R2 R0 r2 r0 R2 R0 r2 r0
slouken@0
   144
		 "pxor %%mm7,%%mm7\n"      //         00 00 00 00 00 00 00 00
slouken@0
   145
		 "punpcklbw %%mm5,%%mm6\n"      //  R3 R2 R1 R0 r3 r2 r1 r0
slouken@0
   146
slouken@0
   147
		 // create Cb (result in mm1)
slouken@0
   148
		 "movd (%1), %%mm1\n"      //         0  0  0  0  u3 u2 u1 u0
slouken@0
   149
		 "punpcklbw %%mm7,%%mm1\n" //         0  u3 0  u2 00 u1 00 u0
slouken@0
   150
		 "punpckldq %%mm1,%%mm1\n" //         00 u1 00 u0 00 u1 00 u0
slouken@1038
   151
		 "psubw _MMX_0080w,%%mm1\n"  // mm1-128:u1 u1 u0 u0 u1 u1 u0 u0 
slouken@0
   152
		 // create Cb_g (result in mm5)
slouken@0
   153
		 "movq %%mm1,%%mm5\n"            // u1 u1 u0 u0 u1 u1 u0 u0
slouken@1038
   154
		 "pmullw _MMX_UgrnRGB,%%mm5\n"    // blue*-109dec=1.7129*64
slouken@1038
   155
		 "pmullw _MMX_UbluRGB,%%mm1\n"    // blue*114dec=1.78125*64
slouken@0
   156
		 "psraw  $6, %%mm5\n"            // blue=red/64
slouken@0
   157
		 "psraw  $6, %%mm1\n"            // blue=blue/64
slouken@0
   158
slouken@0
   159
		 // create G (result in mm7)
slouken@0
   160
		 "movq %%mm2,%%mm3\n"      //   0  L3  0 L1  0 l3  0 l1
slouken@0
   161
		 "movq %%mm4,%%mm7\n"      //   0  L2  0 L0  0 l2  0 l1
slouken@0
   162
		 "paddsw  %%mm5, %%mm3\n"  // lum1+Cb_g:x G3t x G1t x g3t x g1t
slouken@0
   163
		 "paddsw  %%mm5, %%mm7\n"  // lum1+Cb_g:x G2t x G0t x g2t x g0t
slouken@0
   164
		 "paddsw  %%mm0, %%mm3\n"  // lum1+Cr_g:x G3  x G1  x g3  x g1
slouken@0
   165
		 "paddsw  %%mm0, %%mm7\n"  // lum1+blue:x G2  x G0  x g2  x g0
slouken@0
   166
		 "packuswb %%mm3,%%mm3\n"  // G3 G1 g3 g1 G3 G1 g3 g1
slouken@0
   167
		 "packuswb %%mm7,%%mm7\n"  // G2 G0 g2 g0 G2 G0 g2 g0
slouken@0
   168
		 "punpcklbw %%mm3,%%mm7\n" // G3 G2 G1 G0 g3 g2 g1 g0
slouken@0
   169
		 
slouken@0
   170
		 // create B (result in mm5)
slouken@0
   171
		 "movq %%mm2,%%mm3\n"         //   0  L3  0 L1  0 l3  0 l1
slouken@0
   172
		 "movq %%mm4,%%mm5\n"         //   0  L2  0 L0  0 l2  0 l1
slouken@0
   173
		 "paddsw  %%mm1, %%mm3\n"     // lum1+blue:x B3 x B1 x b3 x b1
slouken@0
   174
		 "paddsw  %%mm1, %%mm5\n"     // lum1+blue:x B2 x B0 x b2 x b0
slouken@0
   175
		 "packuswb %%mm3,%%mm3\n"     // B3 B1 b3 b1 B3 B1 b3 b1
slouken@0
   176
		 "packuswb %%mm5,%%mm5\n"     // B2 B0 b2 b0 B2 B0 b2 b0
slouken@0
   177
		 "punpcklbw %%mm3,%%mm5\n"    // B3 B2 B1 B0 b3 b2 b1 b0
slouken@0
   178
slouken@0
   179
		 // fill destination row1 (needed are mm6=Rr,mm7=Gg,mm5=Bb)
slouken@0
   180
slouken@0
   181
		 "pxor %%mm2,%%mm2\n"           //  0  0  0  0  0  0  0  0
slouken@0
   182
		 "pxor %%mm4,%%mm4\n"           //  0  0  0  0  0  0  0  0
slouken@0
   183
		 "movq %%mm6,%%mm1\n"           // R3 R2 R1 R0 r3 r2 r1 r0
slouken@0
   184
		 "movq %%mm5,%%mm3\n"           // B3 B2 B1 B0 b3 b2 b1 b0
slouken@0
   185
		 // process lower lum
slouken@0
   186
		 "punpcklbw %%mm4,%%mm1\n"      //  0 r3  0 r2  0 r1  0 r0
slouken@0
   187
		 "punpcklbw %%mm4,%%mm3\n"      //  0 b3  0 b2  0 b1  0 b0
slouken@0
   188
		 "movq %%mm1,%%mm2\n"           //  0 r3  0 r2  0 r1  0 r0
slouken@0
   189
		 "movq %%mm3,%%mm0\n"           //  0 b3  0 b2  0 b1  0 b0
slouken@0
   190
		 "punpcklwd %%mm1,%%mm3\n"      //  0 r1  0 b1  0 r0  0 b0
slouken@0
   191
		 "punpckhwd %%mm2,%%mm0\n"      //  0 r3  0 b3  0 r2  0 b2
slouken@0
   192
slouken@0
   193
		 "pxor %%mm2,%%mm2\n"           //  0  0  0  0  0  0  0  0
slouken@0
   194
		 "movq %%mm7,%%mm1\n"           // G3 G2 G1 G0 g3 g2 g1 g0
slouken@0
   195
		 "punpcklbw %%mm1,%%mm2\n"      // g3  0 g2  0 g1  0 g0  0
slouken@0
   196
		 "punpcklwd %%mm4,%%mm2\n"      //  0  0 g1  0  0  0 g0  0 
slouken@0
   197
		 "por  %%mm3, %%mm2\n"          //  0 r1 g1 b1  0 r0 g0 b0
slouken@0
   198
		 "movq   %%mm2,(%3)\n"          // wrote out ! row1
slouken@0
   199
slouken@0
   200
		 "pxor %%mm2,%%mm2\n"           //  0  0  0  0  0  0  0  0
slouken@0
   201
		 "punpcklbw %%mm1,%%mm4\n"      // g3  0 g2  0 g1  0 g0  0
slouken@0
   202
		 "punpckhwd %%mm2,%%mm4\n"      //  0  0 g3  0  0  0 g2  0 
slouken@0
   203
		 "por  %%mm0, %%mm4\n"          //  0 r3 g3 b3  0 r2 g2 b2
slouken@0
   204
		 "movq   %%mm4,8(%3)\n"         // wrote out ! row1
slouken@0
   205
		 
slouken@0
   206
		 // fill destination row2 (needed are mm6=Rr,mm7=Gg,mm5=Bb)
slouken@0
   207
		 // this can be done "destructive"
slouken@0
   208
		 "pxor %%mm2,%%mm2\n"           //  0  0  0  0  0  0  0  0
slouken@0
   209
		 "punpckhbw %%mm2,%%mm6\n"      //  0 R3  0 R2  0 R1  0 R0
slouken@0
   210
		 "punpckhbw %%mm1,%%mm5\n"      // G3 B3 G2 B2 G1 B1 G0 B0
slouken@0
   211
		 "movq %%mm5,%%mm1\n"           // G3 B3 G2 B2 G1 B1 G0 B0
slouken@0
   212
		 "punpcklwd %%mm6,%%mm1\n"      //  0 R1 G1 B1  0 R0 G0 B0
slouken@0
   213
		 "movq   %%mm1,(%5)\n"          // wrote out ! row2
slouken@0
   214
		 "punpckhwd %%mm6,%%mm5\n"      //  0 R3 G3 B3  0 R2 G2 B2
slouken@0
   215
		 "movq   %%mm5,8(%5)\n"         // wrote out ! row2
slouken@0
   216
		 
slouken@0
   217
		 "addl  $4,%2\n"            // lum+4
slouken@0
   218
		 "leal  16(%3),%3\n"        // row1+16
slouken@0
   219
		 "leal  16(%5),%5\n"        // row2+16
slouken@0
   220
		 "addl  $2, %%ebx\n"        // cr+2
slouken@0
   221
		 "addl  $2, %1\n"           // cb+2
slouken@0
   222
slouken@0
   223
		 "addl  $4,%6\n"            // x+4
slouken@0
   224
		 "cmpl  %4,%6\n"
slouken@0
   225
slouken@0
   226
		 "jl    1b\n"
slouken@0
   227
		 "addl           %4,     %2\n" // lum += cols 
slouken@0
   228
		 "addl           %8,     %3\n" // row1+= mod
slouken@0
   229
		 "addl           %8,     %5\n" // row2+= mod
slouken@0
   230
		 "movl           $0,     %6\n" // x=0
slouken@0
   231
		 "cmpl           %7,     %2\n"
slouken@0
   232
		 "jl             1b\n"
slouken@0
   233
		 "emms\n"
slouken@0
   234
		 "popl %%ebx\n"
slouken@0
   235
		 :
slouken@0
   236
		 : "m" (cr), "r"(cb),"r"(lum),
icculus@1148
   237
		 "r"(row1),"r"(cols),"r"(row2),"m"(x),"m"(y),"m"(mod));
slouken@0
   238
}
slouken@0
   239
slouken@0
   240
void Color565DitherYV12MMX1X( int *colortab, Uint32 *rgb_2_pix,
slouken@0
   241
                             unsigned char *lum, unsigned char *cr,
slouken@0
   242
                             unsigned char *cb, unsigned char *out,
slouken@0
   243
                             int rows, int cols, int mod )
slouken@0
   244
{
slouken@0
   245
    Uint16 *row1;
slouken@0
   246
    Uint16 *row2;
slouken@0
   247
slouken@0
   248
    unsigned char* y = lum +cols*rows;    /* Pointer to the end */
slouken@0
   249
    int x=0;
slouken@0
   250
    row1 = (Uint16 *)out;                 /* 16 bit target */
slouken@0
   251
    row2 = (Uint16 *)out+cols+mod;        /* start of second row  */
slouken@0
   252
    mod = (mod+cols+mod)*2;               /* increment for row1 in byte */
slouken@0
   253
slouken@0
   254
slouken@0
   255
      __asm__ __volatile__(
slouken@0
   256
         "pushl %%ebx\n"
slouken@0
   257
	 "movl %0, %%ebx\n"
slouken@0
   258
slouken@0
   259
         ".align 8\n"
slouken@0
   260
         "1:\n"
slouken@0
   261
         "movd           (%1),                   %%mm0\n" // 4 Cb         0  0  0  0 u3 u2 u1 u0
slouken@0
   262
         "pxor           %%mm7,                  %%mm7\n"
slouken@0
   263
         "movd           (%%ebx),                %%mm1\n" // 4 Cr                0  0  0  0 v3 v2 v1 v0
slouken@0
   264
         "punpcklbw      %%mm7,                  %%mm0\n" // 4 W cb   0 u3  0 u2  0 u1  0 u0
slouken@0
   265
         "punpcklbw      %%mm7,                  %%mm1\n" // 4 W cr   0 v3  0 v2  0 v1  0 v0
slouken@1038
   266
         "psubw          _MMX_0080w,             %%mm0\n"
slouken@1038
   267
         "psubw          _MMX_0080w,             %%mm1\n"
slouken@0
   268
         "movq           %%mm0,                  %%mm2\n" // Cb                   0 u3  0 u2  0 u1  0 u0
slouken@0
   269
         "movq           %%mm1,                  %%mm3\n" // Cr
slouken@1038
   270
         "pmullw         _MMX_Ugrn565,           %%mm2\n" // Cb2green 0 R3  0 R2  0 R1  0 R0
slouken@0
   271
         "movq           (%2),                   %%mm6\n" // L1      l7 L6 L5 L4 L3 L2 L1 L0
slouken@1038
   272
         "pmullw         _MMX_Ublu5x5,           %%mm0\n" // Cb2blue
slouken@1038
   273
         "pand           _MMX_00FFw,             %%mm6\n" // L1      00 L6 00 L4 00 L2 00 L0
slouken@1038
   274
         "pmullw         _MMX_Vgrn565,           %%mm3\n" // Cr2green
slouken@0
   275
         "movq           (%2),                   %%mm7\n" // L2
slouken@1038
   276
         "pmullw         _MMX_Vred5x5,           %%mm1\n" // Cr2red
slouken@0
   277
         "psrlw          $8,                     %%mm7\n"        // L2           00 L7 00 L5 00 L3 00 L1
slouken@1038
   278
         "pmullw         _MMX_Ycoeff,            %%mm6\n" // lum1
slouken@0
   279
         "paddw          %%mm3,                  %%mm2\n" // Cb2green + Cr2green == green
slouken@1038
   280
         "pmullw         _MMX_Ycoeff,            %%mm7\n" // lum2
slouken@0
   281
slouken@0
   282
         "movq           %%mm6,                  %%mm4\n" // lum1
slouken@0
   283
         "paddw          %%mm0,                  %%mm6\n" // lum1 +blue 00 B6 00 B4 00 B2 00 B0
slouken@0
   284
         "movq           %%mm4,                  %%mm5\n" // lum1
slouken@0
   285
         "paddw          %%mm1,                  %%mm4\n" // lum1 +red  00 R6 00 R4 00 R2 00 R0
slouken@0
   286
         "paddw          %%mm2,                  %%mm5\n" // lum1 +green 00 G6 00 G4 00 G2 00 G0
slouken@0
   287
         "psraw          $6,                     %%mm4\n" // R1 0 .. 64
slouken@0
   288
         "movq           %%mm7,                  %%mm3\n" // lum2                       00 L7 00 L5 00 L3 00 L1
slouken@0
   289
         "psraw          $6,                     %%mm5\n" // G1  - .. +
slouken@0
   290
         "paddw          %%mm0,                  %%mm7\n" // Lum2 +blue 00 B7 00 B5 00 B3 00 B1
slouken@0
   291
         "psraw          $6,                     %%mm6\n" // B1         0 .. 64
slouken@0
   292
         "packuswb       %%mm4,                  %%mm4\n" // R1 R1
slouken@0
   293
         "packuswb       %%mm5,                  %%mm5\n" // G1 G1
slouken@0
   294
         "packuswb       %%mm6,                  %%mm6\n" // B1 B1
slouken@0
   295
         "punpcklbw      %%mm4,                  %%mm4\n"
slouken@0
   296
         "punpcklbw      %%mm5,                  %%mm5\n"
slouken@0
   297
slouken@1038
   298
         "pand           _MMX_red565,            %%mm4\n"
slouken@0
   299
         "psllw          $3,                     %%mm5\n" // GREEN       1
slouken@0
   300
         "punpcklbw      %%mm6,                  %%mm6\n"
slouken@1038
   301
         "pand           _MMX_grn565,            %%mm5\n"
slouken@1038
   302
         "pand           _MMX_red565,            %%mm6\n"
slouken@0
   303
         "por            %%mm5,                  %%mm4\n" //
slouken@0
   304
         "psrlw          $11,                    %%mm6\n" // BLUE        1
slouken@0
   305
         "movq           %%mm3,                  %%mm5\n" // lum2
slouken@0
   306
         "paddw          %%mm1,                  %%mm3\n" // lum2 +red      00 R7 00 R5 00 R3 00 R1
slouken@0
   307
         "paddw          %%mm2,                  %%mm5\n" // lum2 +green 00 G7 00 G5 00 G3 00 G1
slouken@0
   308
         "psraw          $6,                     %%mm3\n" // R2
slouken@0
   309
         "por            %%mm6,                  %%mm4\n" // MM4
slouken@0
   310
         "psraw          $6,                     %%mm5\n" // G2
slouken@0
   311
         "movq           (%2, %4),               %%mm6\n" // L3 load lum2
slouken@0
   312
         "psraw          $6,                     %%mm7\n"
slouken@0
   313
         "packuswb       %%mm3,                  %%mm3\n"
slouken@0
   314
         "packuswb       %%mm5,                  %%mm5\n"
slouken@0
   315
         "packuswb       %%mm7,                  %%mm7\n"
slouken@1038
   316
         "pand           _MMX_00FFw,             %%mm6\n" // L3
slouken@0
   317
         "punpcklbw      %%mm3,                  %%mm3\n"
slouken@0
   318
         "punpcklbw      %%mm5,                  %%mm5\n"
slouken@1038
   319
         "pmullw         _MMX_Ycoeff,            %%mm6\n" // lum3
slouken@0
   320
         "punpcklbw      %%mm7,                  %%mm7\n"
slouken@0
   321
         "psllw          $3,                     %%mm5\n" // GREEN 2
slouken@1038
   322
         "pand           _MMX_red565,            %%mm7\n"
slouken@1038
   323
         "pand           _MMX_red565,            %%mm3\n"
slouken@0
   324
         "psrlw          $11,                    %%mm7\n" // BLUE  2
slouken@1038
   325
         "pand           _MMX_grn565,            %%mm5\n"
slouken@0
   326
         "por            %%mm7,                  %%mm3\n"
slouken@0
   327
         "movq           (%2,%4),                %%mm7\n" // L4 load lum2
slouken@0
   328
         "por            %%mm5,                  %%mm3\n" //
slouken@0
   329
         "psrlw          $8,                     %%mm7\n" // L4
slouken@0
   330
         "movq           %%mm4,                  %%mm5\n"
slouken@0
   331
         "punpcklwd      %%mm3,                  %%mm4\n"
slouken@1038
   332
         "pmullw         _MMX_Ycoeff,            %%mm7\n" // lum4
slouken@0
   333
         "punpckhwd      %%mm3,                  %%mm5\n"
slouken@0
   334
slouken@0
   335
         "movq           %%mm4,                  (%3)\n"  // write row1
slouken@0
   336
         "movq           %%mm5,                  8(%3)\n" // write row1
slouken@0
   337
slouken@0
   338
         "movq           %%mm6,                  %%mm4\n" // Lum3
slouken@0
   339
         "paddw          %%mm0,                  %%mm6\n" // Lum3 +blue
slouken@0
   340
slouken@0
   341
         "movq           %%mm4,                  %%mm5\n" // Lum3
slouken@0
   342
         "paddw          %%mm1,                  %%mm4\n" // Lum3 +red
slouken@0
   343
         "paddw          %%mm2,                  %%mm5\n" // Lum3 +green
slouken@0
   344
         "psraw          $6,                     %%mm4\n"
slouken@0
   345
         "movq           %%mm7,                  %%mm3\n" // Lum4
slouken@0
   346
         "psraw          $6,                     %%mm5\n"
slouken@0
   347
         "paddw          %%mm0,                  %%mm7\n" // Lum4 +blue
slouken@0
   348
         "psraw          $6,                     %%mm6\n" // Lum3 +blue
slouken@0
   349
         "movq           %%mm3,                  %%mm0\n" // Lum4
slouken@0
   350
         "packuswb       %%mm4,                  %%mm4\n"
slouken@0
   351
         "paddw          %%mm1,                  %%mm3\n" // Lum4 +red
slouken@0
   352
         "packuswb       %%mm5,                  %%mm5\n"
slouken@0
   353
         "paddw          %%mm2,                  %%mm0\n" // Lum4 +green
slouken@0
   354
         "packuswb       %%mm6,                  %%mm6\n"
slouken@0
   355
         "punpcklbw      %%mm4,                  %%mm4\n"
slouken@0
   356
         "punpcklbw      %%mm5,                  %%mm5\n"
slouken@0
   357
         "punpcklbw      %%mm6,                  %%mm6\n"
slouken@0
   358
         "psllw          $3,                     %%mm5\n" // GREEN 3
slouken@1038
   359
         "pand           _MMX_red565,            %%mm4\n"
slouken@0
   360
         "psraw          $6,                     %%mm3\n" // psr 6
slouken@0
   361
         "psraw          $6,                     %%mm0\n"
slouken@1038
   362
         "pand           _MMX_red565,            %%mm6\n" // BLUE
slouken@1038
   363
         "pand           _MMX_grn565,            %%mm5\n"
slouken@0
   364
         "psrlw          $11,                    %%mm6\n" // BLUE  3
slouken@0
   365
         "por            %%mm5,                  %%mm4\n"
slouken@0
   366
         "psraw          $6,                     %%mm7\n"
slouken@0
   367
         "por            %%mm6,                  %%mm4\n"
slouken@0
   368
         "packuswb       %%mm3,                  %%mm3\n"
slouken@0
   369
         "packuswb       %%mm0,                  %%mm0\n"
slouken@0
   370
         "packuswb       %%mm7,                  %%mm7\n"
slouken@0
   371
         "punpcklbw      %%mm3,                  %%mm3\n"
slouken@0
   372
         "punpcklbw      %%mm0,                  %%mm0\n"
slouken@0
   373
         "punpcklbw      %%mm7,                  %%mm7\n"
slouken@1038
   374
         "pand           _MMX_red565,            %%mm3\n"
slouken@1038
   375
         "pand           _MMX_red565,            %%mm7\n" // BLUE
slouken@0
   376
         "psllw          $3,                     %%mm0\n" // GREEN 4
slouken@0
   377
         "psrlw          $11,                    %%mm7\n"
slouken@1038
   378
         "pand           _MMX_grn565,            %%mm0\n"
slouken@0
   379
         "por            %%mm7,                  %%mm3\n"
slouken@0
   380
         "por            %%mm0,                  %%mm3\n"
slouken@0
   381
slouken@0
   382
         "movq           %%mm4,                  %%mm5\n"
slouken@0
   383
slouken@0
   384
         "punpcklwd      %%mm3,                  %%mm4\n"
slouken@0
   385
         "punpckhwd      %%mm3,                  %%mm5\n"
slouken@0
   386
slouken@0
   387
         "movq           %%mm4,                  (%5)\n"
slouken@0
   388
	 "movq           %%mm5,                  8(%5)\n"
slouken@0
   389
slouken@0
   390
         "addl           $8,                     %6\n"
slouken@0
   391
         "addl           $8,                     %2\n"
slouken@0
   392
         "addl           $4,                     %%ebx\n"
slouken@0
   393
         "addl           $4,                     %1\n"
slouken@0
   394
         "cmpl           %4,                     %6\n"
slouken@0
   395
         "leal           16(%3),                 %3\n"
slouken@0
   396
	 "leal           16(%5),%5\n" // row2+16
slouken@0
   397
slouken@0
   398
slouken@0
   399
         "jl             1b\n"
slouken@0
   400
	 "addl           %4,     %2\n" // lum += cols 
slouken@0
   401
	 "addl           %8,     %3\n" // row1+= mod
slouken@0
   402
	 "addl           %8,     %5\n" // row2+= mod
slouken@0
   403
	 "movl           $0,     %6\n" // x=0
slouken@0
   404
	 "cmpl           %7,     %2\n"
slouken@0
   405
	 "jl             1b\n"
slouken@0
   406
         "emms\n"
slouken@0
   407
	 "popl %%ebx\n"
slouken@1038
   408
         :
slouken@1038
   409
         :"m" (cr), "r"(cb),"r"(lum),
icculus@1148
   410
	 "r"(row1),"r"(cols),"r"(row2),"m"(x),"m"(y),"m"(mod));
slouken@0
   411
}
slouken@0
   412
slouken@0
   413
#endif /* GCC i386 inline assembly */