gstreamer/libs/colorspace/yuv2rgb.c

/* Gnome-Streamer
 * Copyright (C) <1999> Erik Walthinsen <omega@cse.ogi.edu>
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Library 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
 * Library General Public License for more details.
 *
 * You should have received a copy of the GNU Library 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.
 */

#include "config.h"

#include <math.h>
#include <stdlib.h>

//#define DEBUG_ENABLED
#include <gst/gst.h>
#include <gstcolorspace.h>

//#undef HAVE_LIBMMX

#ifdef HAVE_LIBMMX
#include "mmx.h"
#endif

#include "yuv2rgb.h"

static void gst_colorspace_yuv420P_to_rgb32(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest);
static void gst_colorspace_yuv420P_to_bgr32(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest);
static void gst_colorspace_yuv420P_to_bgr32_mmx(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest);
static void gst_colorspace_yuv420P_to_rgb24(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest);
static void gst_colorspace_yuv420P_to_bgr24(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest);
static void gst_colorspace_yuv420P_to_rgb16(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest);
static void gst_colorspace_yuv420P_to_bgr16_mmx(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest);

static void gst_colorspace_yuv_to_rgb16(GstColorSpaceYUVTables *tables,
	    				unsigned char *lum,
	      				unsigned char *cr,
	        			unsigned char *cb,
		  			unsigned char *out,
		    			int cols, int rows);
static void gst_colorspace_yuv_to_rgb24(GstColorSpaceYUVTables *tables,
	    				unsigned char *lum,
	      				unsigned char *cr,
	        			unsigned char *cb,
		  			unsigned char *out,
		    			int cols, int rows);
static void gst_colorspace_yuv_to_rgb32(GstColorSpaceYUVTables *tables,
	    				unsigned char *lum,
	      				unsigned char *cr,
	        			unsigned char *cb,
		  			unsigned char *out,
		    			int cols, int rows);
#ifdef HAVE_LIBMMX
static void gst_colorspace_yuv_to_bgr32_mmx(GstColorSpaceYUVTables *tables,
	    				unsigned char *lum,
	      				unsigned char *cr,
	        			unsigned char *cb,
		  			unsigned char *out,
		    			int cols, int rows);
static void gst_colorspace_yuv_to_bgr16_mmx(GstColorSpaceYUVTables *tables,
	    				unsigned char *lum,
	      				unsigned char *cr,
	        			unsigned char *cb,
		  			unsigned char *out,
		    			int cols, int rows);
#endif

static GstColorSpaceYUVTables * gst_colorspace_init_yuv(long depth, 
						long red_mask, long green_mask, long blue_mask);

GstColorSpaceConvertFunction gst_colorspace_yuv2rgb_get_converter(GstColorSpaceConverter *space, GstColorSpaceType src, GstColorSpaceType dest) {
  DEBUG("gst_colorspace_yuv2rgb_get_converter %d %d\n", src, dest);
  switch(src) {
    case GST_COLORSPACE_YUV420P:
      space->insize = space->width*space->height+space->width*space->height/2;
      switch(dest) {
        case GST_COLORSPACE_BGR32:
          space->color_tables = gst_colorspace_init_yuv(32, 0xFF0000, 0x00FF00, 0x0000FF);
          space->outsize = space->width*space->height*4;
#ifdef HAVE_LIBMMX
          return gst_colorspace_yuv420P_to_bgr32_mmx;
#else
          return gst_colorspace_yuv420P_to_bgr32;
#endif
        case GST_COLORSPACE_RGB32:
          space->color_tables = gst_colorspace_init_yuv(32, 0x0000FF, 0x00FF00, 0xFF0000);
          space->outsize = space->width*space->height*4;
          return gst_colorspace_yuv420P_to_rgb32;
        case GST_COLORSPACE_RGB24:
          space->color_tables = gst_colorspace_init_yuv(24, 0x0000FF, 0x00FF00, 0xFF0000);
          space->outsize = space->width*space->height*3;
          return gst_colorspace_yuv420P_to_rgb24;
        case GST_COLORSPACE_BGR24:
          space->color_tables = gst_colorspace_init_yuv(24, 0xFF0000, 0x00FF00, 0x0000FF);
          space->outsize = space->width*space->height*3;
          return gst_colorspace_yuv420P_to_bgr24;
        case GST_COLORSPACE_RGB555:
        case GST_COLORSPACE_RGB565:
        case GST_COLORSPACE_BGR555:
          g_return_val_if_fail(space->visual != NULL, NULL);
          space->color_tables = gst_colorspace_init_yuv(16, space->visual->red_mask, space->visual->green_mask, space->visual->blue_mask);
          space->outsize = space->width*space->height*2;
          return gst_colorspace_yuv420P_to_rgb16;
        case GST_COLORSPACE_BGR565:
          g_return_val_if_fail(space->visual != NULL, NULL);
          space->color_tables = gst_colorspace_init_yuv(16, space->visual->red_mask, space->visual->green_mask, space->visual->blue_mask);
          space->outsize = space->width*space->height*2;
#ifdef HAVE_LIBMMX
          return gst_colorspace_yuv420P_to_bgr16_mmx;
#else
          return gst_colorspace_yuv420P_to_rgb16;
#endif
	default:
	  break;
      }
      break;
    default:
      break;
  }
  g_print("gst_colorspace_yuv2rgb not implemented\n");
  return NULL;
}

static void gst_colorspace_yuv420P_to_bgr32(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest) 
{
  int size;
  DEBUG("gst_colorspace_yuv420P_to_bgr32\n");

  size = space->width * space->height;

  gst_colorspace_yuv_to_rgb32(space->color_tables,
			src,                                  	// Y component
                        src+size,     				// cr component
			src+size+(size>>2),		   	// cb component
                        dest,
			space->height,
			space->width);

}

static void gst_colorspace_yuv420P_to_rgb32(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest) 
{
  int size;
  DEBUG("gst_colorspace_yuv420P_to_rgb32\n");

  size = space->width * space->height;

  gst_colorspace_yuv_to_rgb32(space->color_tables,
			src,                                  	// Y component
                        src+size,     				// cr component
			src+size+(size>>2),		   	// cb component
                        dest,
			space->height,
			space->width);

}

static void gst_colorspace_yuv420P_to_bgr24(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest) {
  int size;
  DEBUG("gst_colorspace_yuv420P_to_bgr24\n");

  size = space->width * space->height;

  gst_colorspace_yuv_to_rgb24(space->color_tables,
			src,                                  	// Y component
                        src+size,     				// cr component
			src+size+(size>>2),		   	// cb component
                        dest,
			space->height,
			space->width);
}

static void gst_colorspace_yuv420P_to_rgb24(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest) {
  int size;
  DEBUG("gst_colorspace_yuv420P_to_rgb24\n");

  size = space->width * space->height;

  gst_colorspace_yuv_to_rgb24(space->color_tables,
			src,                                  	// Y component
                        src+size,     				// cr component
			src+size+(size>>2),		   	// cb component
                        dest,
			space->height,
			space->width);

}

static void gst_colorspace_yuv420P_to_rgb16(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest) {
  int size;
  DEBUG("gst_colorspace_yuv420P_to_rgb16\n");

  size = space->width * space->height;

  gst_colorspace_yuv_to_rgb16(space->color_tables,
			src,                                  	// Y component
                        src+size,     				// cr component
			src+size+(size>>2),		   	// cb component
                        dest,
			space->height,
			space->width);

}

#ifdef HAVE_LIBMMX
static mmx_t MMX16_redmask   = (mmx_t)(long long)0xf800f800f800f800LL;             //dd    07c00 7c00h, 07c007c00h
static mmx_t MMX16_grnmask   = (mmx_t)(long long)0x07e007e007e007e0LL;                 //dd    003e0 03e0h, 003e003e0h

static void gst_colorspace_yuv420P_to_bgr32_mmx(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest) {
  int size;
  DEBUG("gst_colorspace_yuv420P_to_rgb32_mmx\n");

  size = space->width * space->height;

  gst_colorspace_yuv_to_bgr32_mmx(NULL,
			src,                                  	// Y component
                        src+size,     				// cr component
			src+size+(size>>2),		   	// cb component
                        dest,
			space->height,
			space->width);

}
static void gst_colorspace_yuv420P_to_bgr16_mmx(GstColorSpaceConverter *space, unsigned char *src, unsigned char *dest) {
  int size;
  DEBUG("gst_colorspace_yuv420P_to_bgr16_mmx \n");

  size = space->width * space->height;

  gst_colorspace_yuv_to_bgr16_mmx(NULL,
			src,                                  	// Y component
                        src+size,     				// cr component
			src+size+(size>>2),		   	// cb component
                        dest,
			space->height,
			space->width);
  DEBUG("gst_colorspace_yuv420P_to_bgr16_mmx done\n");

}
#endif

/*
 * How many 1 bits are there in the longword.
 * Low performance, do not call often.
 */

static int
number_of_bits_set(a)
unsigned long a;
{
    if(!a) return 0;
    if(a & 1) return 1 + number_of_bits_set(a >> 1);
    return(number_of_bits_set(a >> 1));
}

/*
 * Shift the 0s in the least significant end out of the longword.
 * Low performance, do not call often.
 */
static unsigned long
shifted_down(a)
unsigned long a;
{
    if(!a) return 0;
    if(a & 1) return a;
    return a >> 1;
}

/*
 * How many 0 bits are there at most significant end of longword.
 * Low performance, do not call often.
 */
static int
free_bits_at_top(a)
unsigned long a;
{
      /* assume char is 8 bits */
    if(!a) return sizeof(unsigned long) * 8;
        /* assume twos complement */
    if(((long)a) < 0l) return 0;
    return 1 + free_bits_at_top ( a << 1);
}

/*
 * How many 0 bits are there at least significant end of longword.
 * Low performance, do not call often.
 */
static int
free_bits_at_bottom(a)
unsigned long a;
{
      /* assume char is 8 bits */
    if(!a) return sizeof(unsigned long) * 8;
    if(((long)a) & 1l) return 0;
    return 1 + free_bits_at_bottom ( a >> 1);
}

/*
 *--------------------------------------------------------------
 *
 * InitColor16Dither --
 *
 *	To get rid of the multiply and other conversions in color
 *	dither, we use a lookup table.
 *
 * Results:
 *	None.
 *
 * Side effects:
 *	The lookup tables are initialized.
 *
 *--------------------------------------------------------------
 */

static GstColorSpaceYUVTables *
gst_colorspace_init_yuv(long depth, long red_mask, long green_mask, long blue_mask)
{
    int CR, CB, i;
    int *L_tab, *Cr_r_tab, *Cr_g_tab, *Cb_g_tab, *Cb_b_tab;
    long *r_2_pix_alloc;
    long *g_2_pix_alloc;
    long *b_2_pix_alloc;
    GstColorSpaceYUVTables *tables = g_malloc(sizeof(GstColorSpaceYUVTables));

    L_tab    = tables->L_tab = (int *)malloc(256*sizeof(int)); 
    Cr_r_tab = tables->Cr_r_tab = (int *)malloc(256*sizeof(int));
    Cr_g_tab = tables->Cr_g_tab = (int *)malloc(256*sizeof(int));
    Cb_g_tab = tables->Cb_g_tab = (int *)malloc(256*sizeof(int));
    Cb_b_tab = tables->Cb_b_tab = (int *)malloc(256*sizeof(int));

    r_2_pix_alloc = (long *)malloc(768*sizeof(long));
    g_2_pix_alloc = (long *)malloc(768*sizeof(long));
    b_2_pix_alloc = (long *)malloc(768*sizeof(long));

    if (L_tab == NULL ||
	Cr_r_tab == NULL ||
	Cr_g_tab == NULL ||
	Cb_g_tab == NULL ||
	Cb_b_tab == NULL ||
	r_2_pix_alloc == NULL ||
	g_2_pix_alloc == NULL ||
	b_2_pix_alloc == NULL) {
      fprintf(stderr, "Could not get enough memory in InitColorDither\n");
      exit(1);
    }

    for (i=0; i<256; i++) {
      L_tab[i] = i;
      /*
      if (gammaCorrectFlag) {
	L_tab[i] = GAMMA_CORRECTION(i);
      }
      */
      
      CB = CR = i;
      /*
      if (chromaCorrectFlag) {
	CB -= 128; 
	CB = CHROMA_CORRECTION128(CB);
	CR -= 128;
	CR = CHROMA_CORRECTION128(CR);
      } 
      else 
      */
      {
	CB -= 128; CR -= 128;
      }
      Cr_r_tab[i] =  (0.419/0.299) * CR;
      Cr_g_tab[i] = -(0.299/0.419) * CR;
      Cb_g_tab[i] = -(0.114/0.331) * CB; 
      Cb_b_tab[i] =  (0.587/0.331) * CB;

    }

    /* 
     * Set up entries 0-255 in rgb-to-pixel value tables.
     */
    for (i = 0; i < 256; i++) {
      r_2_pix_alloc[i + 256] = i >> (8 - number_of_bits_set(red_mask));
      r_2_pix_alloc[i + 256] <<= free_bits_at_bottom(red_mask);
      g_2_pix_alloc[i + 256] = i >> (8 - number_of_bits_set(green_mask));
      g_2_pix_alloc[i + 256] <<= free_bits_at_bottom(green_mask);
      b_2_pix_alloc[i + 256] = i >> (8 - number_of_bits_set(blue_mask));
      b_2_pix_alloc[i + 256] <<= free_bits_at_bottom(blue_mask);
      /*
       * If we have 16-bit output depth, then we double the value
       * in the top word. This means that we can write out both
       * pixels in the pixel doubling mode with one op. It is 
       * harmless in the normal case as storing a 32-bit value
       * through a short pointer will lose the top bits anyway.
       * A similar optimisation for Alpha for 64 bit has been
       * prepared for, but is not yet implemented.
       */
      if(!(depth == 32) && !(depth == 24)) {

	r_2_pix_alloc[i + 256] |= (r_2_pix_alloc[i + 256]) << 16;
	g_2_pix_alloc[i + 256] |= (g_2_pix_alloc[i + 256]) << 16;
	b_2_pix_alloc[i + 256] |= (b_2_pix_alloc[i + 256]) << 16;

      }
#ifdef SIXTYFOUR_BIT
      if(depth == 32) {

	r_2_pix_alloc[i + 256] |= (r_2_pix_alloc[i + 256]) << 32;
	g_2_pix_alloc[i + 256] |= (g_2_pix_alloc[i + 256]) << 32;
	b_2_pix_alloc[i + 256] |= (b_2_pix_alloc[i + 256]) << 32;

      }
#endif
    }

    /*
     * Spread out the values we have to the rest of the array so that
     * we do not need to check for overflow.
     */
    for (i = 0; i < 256; i++) {
      r_2_pix_alloc[i] = r_2_pix_alloc[256];
      r_2_pix_alloc[i+ 512] = r_2_pix_alloc[511];
      g_2_pix_alloc[i] = g_2_pix_alloc[256];
      g_2_pix_alloc[i+ 512] = g_2_pix_alloc[511];
      b_2_pix_alloc[i] = b_2_pix_alloc[256];
      b_2_pix_alloc[i+ 512] = b_2_pix_alloc[511];
    }

    tables->r_2_pix = r_2_pix_alloc + 256;
    tables->g_2_pix = g_2_pix_alloc + 256;
    tables->b_2_pix = b_2_pix_alloc + 256;

    return tables;

}

/*
 *--------------------------------------------------------------
 *
 * Color16DitherImage --
 *
 *	Converts image into 16 bit color.
 *
 * Results:
 *	None.
 *
 * Side effects:
 *	None.
 *
 *--------------------------------------------------------------
 */

static void
gst_colorspace_yuv_to_rgb16(tables, lum, cb, cr, out, rows, cols)
  GstColorSpaceYUVTables *tables;
  unsigned char *lum;
  unsigned char *cr;
  unsigned char *cb;
  unsigned char *out;
  int cols, rows;

{
    int L, CR, CB;
    unsigned short *row1, *row2;
    unsigned char *lum2;
    int x, y;
    int cr_r;
    int crb_g;
    int cb_b;
    int cols_2 = cols>>1;

    row1 = (unsigned short *)out;
    row2 = row1 + cols;
    lum2 = lum + cols;

    for (y=rows>>1; y; y--) {
	for (x=cols_2; x; x--) {

	    CR = *cr++;
	    CB = *cb++;
	    cr_r = tables->Cr_r_tab[CR];
	    crb_g = tables->Cr_g_tab[CR] + tables->Cb_g_tab[CB];
	    cb_b = tables->Cb_b_tab[CB];

            L = tables->L_tab[(int) *lum++];

	    *row1++ = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);

            L = tables->L_tab[(int) *lum++];

	    *row1++ = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);

	    /*
	     * Now, do second row.
	     */
	    L = tables->L_tab[(int) *lum2++];

	    *row2++ = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);

	    L = tables->L_tab[(int) *lum2++];

	    *row2++ = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);
	}
        /*
         * These values are at the start of the next line, (due
         * to the ++'s above),but they need to be at the start
         * of the line after that.
         */
	lum = lum2;
	row1 = row2;
	lum2 += cols;
	row2 += cols;
    }
}

static void
gst_colorspace_yuv_to_rgb24(tables, lum, cb, cr, out, rows, cols)
  GstColorSpaceYUVTables *tables;
  unsigned char *lum;
  unsigned char *cr;
  unsigned char *cb;
  unsigned char *out;
  int cols, rows;

{
    int L, CR, CB;
    unsigned char *row1, *row2;
    unsigned char *lum2;
    int x, y;
    int cr_r;
    int crb_g;
    int cb_b;
    int cols_2 = cols>>1;
    int cols_3 = cols*3;
    unsigned char pixels[4];

    row1 = out;
    row2 = row1 + cols_3;
    lum2 = lum + cols;
    for (y=rows>>1; y; y--) {
	for (x=cols_2; x; x--) {

	    CR = *cr++;
	    CB = *cb++;
	    cr_r = tables->Cr_r_tab[CR];
	    crb_g = tables->Cr_g_tab[CR] + tables->Cb_g_tab[CB];
	    cb_b = tables->Cb_b_tab[CB];

            L = tables->L_tab[(int) *lum++];

	    ((int *)pixels)[0] = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);
	    *row1++ = pixels[0]; *row1++ = pixels[1]; *row1++ = pixels[2];

            L = tables->L_tab[(int) *lum++];

	    ((int *)pixels)[0] = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);
	    *row1++ = pixels[0]; *row1++ = pixels[1]; *row1++ = pixels[2];

	    /*
	     * Now, do second row.
	     */

	    L = tables->L_tab [(int) *lum2++];

	    ((int *)pixels)[0] = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);
	    *row2++ = pixels[0]; *row2++ = pixels[1]; *row2++ = pixels[2];

	    L = tables->L_tab [(int) *lum2++];

	    ((int *)pixels)[0] = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);
	    *row2++ = pixels[0]; *row2++ = pixels[1]; *row2++ = pixels[2];
	}
	lum = lum2;
	row1 = row2;
	lum2 += cols;
	row2 += cols_3;
    }
}

/*
 *--------------------------------------------------------------
 *
 * Color32DitherImage --
 *
 *	Converts image into 32 bit color (or 24-bit non-packed).
 *
 * Results:
 *	None.
 *
 * Side effects:
 *	None.
 *
 *--------------------------------------------------------------
 */

/*
 * This is a copysoft version of the function above with ints instead
 * of shorts to cause a 4-byte pixel size
 */

static void
gst_colorspace_yuv_to_rgb32(tables, lum, cb, cr, out, rows, cols)
  GstColorSpaceYUVTables *tables;
  unsigned char *lum;
  unsigned char *cr;
  unsigned char *cb;
  unsigned char *out;
  int cols, rows;

{
    int L, CR, CB;
    unsigned int *row1, *row2;
    unsigned char *lum2;
    int x, y;
    int cr_r;
    int crb_g;
    int cb_b;
    int cols_2 = cols>>1;

    row1 = (guint32  *)out;
    row2 = row1 + cols;
    lum2 = lum + cols;
    for (y=rows>>1; y; y--) {
	for (x=cols_2; x; x--) {

	    CR = *cr++;
	    CB = *cb++;
	    cr_r = tables->Cr_r_tab[CR];
	    crb_g = tables->Cr_g_tab[CR] + tables->Cb_g_tab[CB];
	    cb_b = tables->Cb_b_tab[CB];

            L = tables->L_tab[(int) *lum++];

	    *row1++ = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);

            L = tables->L_tab[(int) *lum++];

	    *row1++ = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);

	    /*
	     * Now, do second row.
	     */

	    L = tables->L_tab [(int) *lum2++];

	    *row2++ = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);

	    L = tables->L_tab [(int) *lum2++];

	    *row2++ = (tables->r_2_pix[L+cr_r] | tables->g_2_pix[L+crb_g] | tables->b_2_pix[L+cb_b]);
	}
	lum = lum2;
	row1 = row2;
	lum2 += cols;
	row2 += cols;
    }
}

#ifdef HAVE_LIBMMX
static mmx_t MMX_10w           = (mmx_t)(long long)0x000D000D000D000DLL;                     //dd    00080 0080h, 000800080h
static mmx_t MMX_80w           = (mmx_t)(long long)0x0080008000800080LL;                     //dd    00080 0080h, 000800080h

static mmx_t MMX_00FFw         = (mmx_t)(long long)0x00ff00ff00ff00ffLL;                     //dd    000FF 00FFh, 000FF00FFh
static mmx_t MMX_FF00w         = (mmx_t)(long long)0xff00ff00ff00ff00LL;                     //dd    000FF 00FFh, 000FF00FFh

static mmx_t MMX16_Vredcoeff   = (mmx_t)(long long)0x0066006600660066LL;                     //dd    00066 0066h, 000660066h
static mmx_t MMX16_Ublucoeff   = (mmx_t)(long long)0x0081008100810081LL;                     //dd    00081 0081h, 000810081h
static mmx_t MMX16_Ugrncoeff   = (mmx_t)(long long)0xffe8ffe8ffe8ffe8LL;             //dd    0FFE7 FFE7h, 0FFE7FFE7h
static mmx_t MMX16_Vgrncoeff   = (mmx_t)(long long)0xffcdffcdffcdffcdLL;             //dd    0FFCC FFCCh, 0FFCCFFCCh

static mmx_t MMX16_Ycoeff      = (mmx_t)(long long)0x004a004a004a004aLL;                     //dd    0004A 004Ah, 0004A004Ah


static mmx_t MMX32_Vredcoeff     = (mmx_t)(long long)0x0059005900590059LL;  
static mmx_t MMX32_Ubluecoeff    = (mmx_t)(long long)0x0072007200720072LL;    
static mmx_t MMX32_Ugrncoeff     = (mmx_t)(long long)0xffeaffeaffeaffeaLL; 
static mmx_t MMX32_Vgrncoeff     = (mmx_t)(long long)0xffd2ffd2ffd2ffd2LL;  

static void
gst_colorspace_yuv_to_bgr16_mmx(tables, lum, cr, cb, out, rows, cols)
  GstColorSpaceYUVTables *tables;
  unsigned char *lum;
  unsigned char *cr;
  unsigned char *cb;
  unsigned char *out;
  int cols, rows;

{
    unsigned short *row1 = (unsigned short* )out;         // 32 bit target
    int cols8 = cols>>3;

    int y, x; 

    DEBUG("gst_colorspace_yuv420P_to_bgr16_mmx %p %p %p\n", lum, cr, cb);

    for (y=rows>>1; y; y--) {
      for (x=cols8; x; x--) {
	
        movd_m2r(*(mmx_t *)cr, mm0);		// 4 Cr     0  0  0  0 u3 u2 u1 u0
        pxor_r2r(mm7, mm7);
        movd_m2r(*(mmx_t *)cb, mm1);		// 4 Cb     0  0  0  0 v3 v2 v1 v0
        punpcklbw_r2r(mm7, mm0);		// 4 W cb   0 u3  0 u2  0 u1  0 u0
        punpcklbw_r2r(mm7, mm1);		// 4 W cr   0 v3  0 v2  0 v1  0 v0
        psubw_m2r(MMX_80w, mm0);
        psubw_m2r(MMX_80w, mm1);
        movq_r2r(mm0, mm2);			// Cb       0 u3  0 u2  0 u1  0 u0
        movq_r2r(mm1, mm3);			// Cr
        pmullw_m2r(MMX16_Ugrncoeff, mm2);	// Cb2green 0 R3  0 R2  0 R1  0 R0
        movq_m2r(*(mmx_t *)lum, mm6);		// L1      l7 L6 L5 L4 L3 L2 L1 L0
        pmullw_m2r(MMX16_Ublucoeff, mm0);	// Cb2blue
        pand_m2r(MMX_00FFw, mm6);		// L1      00 L6 00 L4 00 L2 00 L0
        pmullw_m2r(MMX16_Vgrncoeff, mm3);	// Cr2green
        movq_m2r(*(mmx_t *)lum, mm7); 		// L2
        pmullw_m2r(MMX16_Vredcoeff, mm1);	// Cr2red
        psubw_m2r(MMX_10w, mm6);
        psrlw_i2r(8, mm7);			// L2           00 L7 00 L5 00 L3 00 L1
        pmullw_m2r(MMX16_Ycoeff, mm6);		// lum1
        psubw_m2r(MMX_10w, mm7);
        paddw_r2r(mm3, mm2);			// Cb2green + Cr2green == green
        pmullw_m2r(MMX16_Ycoeff, mm7);		// lum2

        movq_r2r(mm6, mm4);			// lum1
        paddw_r2r(mm0, mm6);			// lum1 +blue 00 B6 00 B4 00 B2 00 B0
        movq_r2r(mm4, mm5);  			// lum1
        paddw_r2r(mm1, mm4);  			// lum1 +red  00 R6 00 R4 00 R2 00 R0
        paddw_r2r(mm2, mm5);  			// lum1 +green 00 G6 00 G4 00 G2 00 G0
        psraw_i2r(6, mm4);  			// R1 0 .. 64
        movq_r2r(mm7, mm3);  			// lum2                       00 L7 00 L5 00 L3 00 L1
        psraw_i2r(6, mm5);  			// G1  - .. +
        paddw_r2r(mm0, mm7);  			// Lum2 +blue 00 B7 00 B5 00 B3 00 B1
        psraw_i2r(6, mm6);  			// B1         0 .. 64
        packuswb_r2r(mm4, mm4);  		// R1 R1
        packuswb_r2r(mm5, mm5);  		// G1 G1
        packuswb_r2r(mm6, mm6);  		// B1 B1
        punpcklbw_r2r(mm4, mm4);
        punpcklbw_r2r(mm5, mm5);

        pand_m2r(MMX16_redmask, mm4);
        psllw_i2r(3, mm5);  			// GREEN       1
        punpcklbw_r2r(mm6, mm6);
        pand_m2r(MMX16_grnmask, mm5);
        pand_m2r(MMX16_redmask, mm6);
        por_r2r(mm5, mm4); 			//
        psrlw_i2r(11, mm6);                	// BLUE        1
        movq_r2r(mm3, mm5); 			// lum2
        paddw_r2r(mm1, mm3);        		// lum2 +red      00 R7 00 R5 00 R3 00 R1
        paddw_r2r(mm2, mm5); 			// lum2 +green 00 G7 00 G5 00 G3 00 G1
        psraw_i2r(6, mm3); 			// R2
        por_r2r(mm6, mm4); 			// MM4
        psraw_i2r(6, mm5); 			// G2
        movq_m2r(*(mmx_t *)(lum+cols), mm6); 	// L3 load lum2
        psraw_i2r(6, mm7);
        packuswb_r2r(mm3, mm3);
        packuswb_r2r(mm5, mm5);
        packuswb_r2r(mm7, mm7);
        pand_m2r(MMX_00FFw, mm6);  		// L3
        psubw_m2r(MMX_10w, mm6);
        punpcklbw_r2r(mm3, mm3);
         //                              "psubw          MMX_10w,                        %%mm6\n"  // L3
        punpcklbw_r2r(mm5, mm5);
        pmullw_m2r(MMX16_Ycoeff, mm6);  	// lum3
        punpcklbw_r2r(mm7, mm7);
        psllw_i2r(3, mm5);  			// GREEN 2
        pand_m2r(MMX16_redmask, mm7);
        pand_m2r(MMX16_redmask, mm3);
        psrlw_i2r(11, mm7);  			// BLUE  2
        pand_m2r(MMX16_grnmask, mm5);
        por_r2r(mm7, mm3);
        movq_m2r(*(mmx_t *)(lum+cols), mm7); 	// L4 load lum2
        por_r2r(mm5, mm3);     			//
        psrlw_i2r(8, mm7);    			// L4
        movq_r2r(mm4, mm5);
         //                              "psubw          MMX_10w,                        %%mm7\n"                // L4
        punpcklwd_r2r(mm3, mm4);
        psubw_m2r(MMX_10w, mm7);
        pmullw_m2r(MMX16_Ycoeff, mm7);    	// lum4
        punpckhwd_r2r(mm3, mm5);

        movq_r2m(mm4, *(row1)); 		// write row1
        movq_r2m(mm5, *(row1+4)); 		// write row1

        movq_r2r(mm6, mm4);        		// Lum3
        paddw_r2r(mm0, mm6);                	// Lum3 +blue

        movq_r2r(mm4, mm5);                     // Lum3
        paddw_r2r(mm1, mm4);       		// Lum3 +red
        paddw_r2r(mm2, mm5);                    // Lum3 +green
        psraw_i2r(6, mm4);
        movq_r2r(mm7, mm3);                     // Lum4
        psraw_i2r(6, mm5);
        paddw_r2r(mm0, mm7);                   	// Lum4 +blue
        psraw_i2r(6, mm6);                        	// Lum3 +blue
        movq_r2r(mm3, mm0);  			// Lum4
        packuswb_r2r(mm4, mm4);
        paddw_r2r(mm1, mm3);  			// Lum4 +red
        packuswb_r2r(mm5, mm5);
        paddw_r2r(mm2, mm0);         		// Lum4 +green
        packuswb_r2r(mm6, mm6);
        punpcklbw_r2r(mm4, mm4);
        punpcklbw_r2r(mm5, mm5);
        punpcklbw_r2r(mm6, mm6);
        psllw_i2r(3, mm5); 			// GREEN 3
        pand_m2r(MMX16_redmask, mm4);
        psraw_i2r(6, mm3); 			// psr 6
        psraw_i2r(6, mm0);
        pand_m2r(MMX16_redmask, mm6); 		// BLUE
        pand_m2r(MMX16_grnmask, mm5);
        psrlw_i2r(11, mm6);  			// BLUE  3
        por_r2r(mm5, mm4);
        psraw_i2r(6, mm7);
        por_r2r(mm6, mm4);
        packuswb_r2r(mm3, mm3);
        packuswb_r2r(mm0, mm0);
        packuswb_r2r(mm7, mm7);
        punpcklbw_r2r(mm3, mm3);
        punpcklbw_r2r(mm0, mm0);
        punpcklbw_r2r(mm7, mm7);
        pand_m2r(MMX16_redmask, mm3);
        pand_m2r(MMX16_redmask, mm7); 		// BLUE
        psllw_i2r(3, mm0); 			// GREEN 4
        psrlw_i2r(11, mm7);
        pand_m2r(MMX16_grnmask, mm0);
        por_r2r(mm7, mm3);
        por_r2r(mm0, mm3);

        movq_r2r(mm4, mm5);

        punpcklwd_r2r(mm3, mm4);
        punpckhwd_r2r(mm3, mm5);

        movq_r2m(mm4, *(row1+cols));
        movq_r2m(mm5, *(row1+cols+4));

        lum+=8;
        cr+=4;
        cb+=4;
        row1 +=8;
      }
      lum += cols;
      row1 += cols;
    }

    emms();

}
static void
gst_colorspace_yuv_to_bgr32_mmx(tables, lum, cr, cb, out, rows, cols)
  GstColorSpaceYUVTables *tables;
  unsigned char *lum;
  unsigned char *cr;
  unsigned char *cb;
  unsigned char *out;
  int cols, rows;

{
    guint32 *row1 = (guint32 *)out;         // 32 bit target
    int cols4 = cols>>2;

    int y, x; 
    
    for (y=rows>>1; y; y--) {
      for (x=cols4; x; x--) {

        // create Cr (result in mm1)
        movd_m2r(*(mmx_t *)cr, mm1);      	//         0  0  0  0  v3 v2 v1 v0
        pxor_r2r(mm7, mm7);      		//         00 00 00 00 00 00 00 00
        movd_m2r(*(mmx_t *)lum, mm2);           //          0  0  0  0 l3 l2 l1 l0
        punpcklbw_r2r(mm7, mm1); 		//         0  v3 0  v2 00 v1 00 v0
        punpckldq_r2r(mm1, mm1); 		//         00 v1 00 v0 00 v1 00 v0
        psubw_m2r(MMX_80w, mm1);   		// mm1-128:r1 r1 r0 r0 r1 r1 r0 r0 

        // create Cr_g (result in mm0)
        movq_r2r(mm1, mm0);           		// r1 r1 r0 r0 r1 r1 r0 r0
        pmullw_m2r(MMX32_Vgrncoeff, mm0); 	// red*-46dec=0.7136*64
        pmullw_m2r(MMX32_Vredcoeff, mm1); 	// red*89dec=1.4013*64
        psraw_i2r(6, mm0);           		// red=red/64
        psraw_i2r(6, mm1);           		// red=red/64
		 
        // create L1 L2 (result in mm2,mm4)
        // L2=lum+cols
        movq_m2r(*(mmx_t *)(lum+cols),mm3);     //    0  0  0  0 L3 L2 L1 L0
        punpckldq_r2r(mm3, mm2);      		//   L3 L2 L1 L0 l3 l2 l1 l0
        movq_r2r(mm2, mm4);           		//   L3 L2 L1 L0 l3 l2 l1 l0
        pand_m2r(MMX_FF00w, mm2);      		//   L3 0  L1  0 l3  0 l1  0
        pand_m2r(MMX_00FFw, mm4);      		//   0  L2  0 L0  0 l2  0 l0
        psrlw_i2r(8, mm2);             		//   0  L3  0 L1  0 l3  0 l1

        // create R (result in mm6)
        movq_r2r(mm2, mm5);           		//   0 L3  0 L1  0 l3  0 l1
        movq_r2r(mm4, mm6);           		//   0 L2  0 L0  0 l2  0 l0
        paddsw_r2r(mm1, mm5);       		// lum1+red:x R3 x R1 x r3 x r1
        paddsw_r2r(mm1, mm6);       		// lum1+red:x R2 x R0 x r2 x r0
        packuswb_r2r(mm5, mm5);       		//  R3 R1 r3 r1 R3 R1 r3 r1
        packuswb_r2r(mm6, mm6);       		//  R2 R0 r2 r0 R2 R0 r2 r0
        pxor_r2r(mm7, mm7);      		//  00 00 00 00 00 00 00 00
        punpcklbw_r2r(mm5, mm6);      		//  R3 R2 R1 R0 r3 r2 r1 r0

        // create Cb (result in mm1)
        movd_m2r(*(mmx_t *)cb, mm1);      	//         0  0  0  0  u3 u2 u1 u0
        punpcklbw_r2r(mm7, mm1); 		//         0  u3 0  u2 00 u1 00 u0
        punpckldq_r2r(mm1, mm1); 		//         00 u1 00 u0 00 u1 00 u0
        psubw_m2r(MMX_80w, mm1);   		// mm1-128:u1 u1 u0 u0 u1 u1 u0 u0 
        // create Cb_g (result in mm5)
        movq_r2r(mm1, mm5);            		// u1 u1 u0 u0 u1 u1 u0 u0
        pmullw_m2r(MMX32_Ugrncoeff, mm5);  	// blue*-109dec=1.7129*64
        pmullw_m2r(MMX32_Ubluecoeff, mm1); 	// blue*114dec=1.78125*64
        psraw_i2r(6, mm5);            		// blue=red/64
        psraw_i2r(6, mm1);            		// blue=blue/64

        // create G (result in mm7)
        movq_r2r(mm2, mm3);      		//   0  L3  0 L1  0 l3  0 l1
        movq_r2r(mm4, mm7);      		//   0  L2  0 L0  0 l2  0 l1
        paddsw_r2r(mm5, mm3);  			// lum1+Cb_g:x G3t x G1t x g3t x g1t
        paddsw_r2r(mm5, mm7);  			// lum1+Cb_g:x G2t x G0t x g2t x g0t
        paddsw_r2r(mm0, mm3);  			// lum1+Cr_g:x G3  x G1  x g3  x g1
        paddsw_r2r(mm0, mm7);  			// lum1+blue:x G2  x G0  x g2  x g0
        packuswb_r2r(mm3, mm3);  		// G3 G1 g3 g1 G3 G1 g3 g1
        packuswb_r2r(mm7, mm7);  		// G2 G0 g2 g0 G2 G0 g2 g0
        punpcklbw_r2r(mm3, mm7); 		// G3 G2 G1 G0 g3 g2 g1 g0

        // create B (result in mm5)
        movq_r2r(mm2, mm3);         		//   0  L3  0 L1  0 l3  0 l1
        movq_r2r(mm4, mm5);         		//   0  L2  0 L0  0 l2  0 l1
        paddsw_r2r(mm1, mm3);     		// lum1+blue:x B3 x B1 x b3 x b1
        paddsw_r2r(mm1, mm5);     		// lum1+blue:x B2 x B0 x b2 x b0
        packuswb_r2r(mm3, mm3);     		// B3 B1 b3 b1 B3 B1 b3 b1
        packuswb_r2r(mm5, mm5);     		// B2 B0 b2 b0 B2 B0 b2 b0
        punpcklbw_r2r(mm3, mm5);    		// B3 B2 B1 B0 b3 b2 b1 b0

        // fill destination row1 (needed are mm6=Rr,mm7=Gg,mm5=Bb)

        pxor_r2r(mm2, mm2);           		//  0  0  0  0  0  0  0  0
        pxor_r2r(mm4, mm4);           		//  0  0  0  0  0  0  0  0
        movq_r2r(mm6, mm1);           		// R3 R2 R1 R0 r3 r2 r1 r0
        movq_r2r(mm5, mm3);           		// B3 B2 B1 B0 b3 b2 b1 b0
        // process lower lum
        punpcklbw_r2r(mm4, mm1);      		//  0 r3  0 r2  0 r1  0 r0
        punpcklbw_r2r(mm4, mm3);      		//  0 b3  0 b2  0 b1  0 b0
        movq_r2r(mm1, mm2);           		//  0 r3  0 r2  0 r1  0 r0
        movq_r2r(mm3, mm0);           		//  0 b3  0 b2  0 b1  0 b0
        punpcklwd_r2r(mm1, mm3);      		//  0 r1  0 b1  0 r0  0 b0
        punpckhwd_r2r(mm2, mm0);      		//  0 r3  0 b3  0 r2  0 b2

        pxor_r2r(mm2, mm2);           		//  0  0  0  0  0  0  0  0
        movq_r2r(mm7, mm1);           		// G3 G2 G1 G0 g3 g2 g1 g0
        punpcklbw_r2r(mm1, mm2);      		// g3  0 g2  0 g1  0 g0  0
        punpcklwd_r2r(mm4, mm2);      		//  0  0 g1  0  0  0 g0  0 
        por_r2r(mm3, mm2);      		//  0 r1 g1 b1  0 r0 g0 b0
        movq_r2m(mm2, *(mmx_t *)row1);      	// wrote out ! row1

        pxor_r2r(mm2, mm2);           		//  0  0  0  0  0  0  0  0
        punpcklbw_r2r(mm1, mm4);      		// g3  0 g2  0 g1  0 g0  0
        punpckhwd_r2r(mm2, mm4);      		//  0  0 g3  0  0  0 g2  0 
        por_r2r(mm0, mm4);      		//  0 r3 g3 b3  0 r2 g2 b2
        movq_r2m(mm4, *(mmx_t *)(row1+2)); 	// wrote out ! row1
		 
        // fill destination row2 (needed are mm6=Rr,mm7=Gg,mm5=Bb)
        // this can be done "destructive"
        pxor_r2r(mm2, mm2);           		//  0  0  0  0  0  0  0  0
        punpckhbw_r2r(mm2, mm6);      		//  0 R3  0 R2  0 R1  0 R0
        punpckhbw_r2r(mm1, mm5);      		// G3 B3 G2 B2 G1 B1 G0 B0
        movq_r2r(mm5, mm1);           		// G3 B3 G2 B2 G1 B1 G0 B0
        punpcklwd_r2r(mm6, mm1);      		//  0 R1 G1 B1  0 R0 G0 B0
        movq_r2m(mm1, *(mmx_t *)(row1+cols));	// wrote out ! row2
        punpckhwd_r2r(mm6, mm5);      		//  0 R3 G3 B3  0 R2 G2 B2
        movq_r2m(mm5, *(mmx_t *)(row1+cols+2)); // wrote out ! row2
		 
        lum+=4;
        cr+=2;
        cb+=2;
        row1 +=4;
      }
      lum += cols;
      row1 += cols;
    }

    emms();

}
#endif