| /* GStreamer |
| * 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. |
| */ |
| |
| #ifdef HAVE_CONFIG_H |
| #include "config.h" |
| #endif |
| |
| #include <math.h> |
| #include <stdlib.h> |
| |
| #include "yuv2rgb.h" |
| |
| #undef HAVE_LIBMMX |
| |
| #ifdef HAVE_LIBMMX |
| #include <mmx.h> |
| #endif |
| |
| static int V_r_tab[256]; |
| static int V_g_tab[256]; |
| static int U_g_tab[256]; |
| static int U_b_tab[256]; |
| |
| #define CB_BASE 1 |
| #define CR_BASE (CB_BASE*CB_RANGE) |
| #define LUM_BASE (CR_BASE*CR_RANGE) |
| |
| #define Min(x,y) (((x) < (y)) ? (x) : (y)) |
| #define Max(x,y) (((x) > (y)) ? (x) : (y)) |
| |
| #define GAMMA_CORRECTION(x) ((int)(pow((x) / 255.0, 1.0 / gammaCorrect) * 255.0)) |
| #define CHROMA_CORRECTION256(x) ((x) >= 128 \ |
| ? 128 + Min(127, (int)(((x) - 128.0) * chromaCorrect)) \ |
| : 128 - Min(128, (int)((128.0 - (x)) * chromaCorrect))) |
| #define CHROMA_CORRECTION128(x) ((x) >= 0 \ |
| ? Min(127, (int)(((x) * chromaCorrect))) \ |
| : Max(-128, (int)(((x) * chromaCorrect)))) |
| #define CHROMA_CORRECTION256D(x) ((x) >= 128 \ |
| ? 128.0 + Min(127.0, (((x) - 128.0) * chromaCorrect)) \ |
| : 128.0 - Min(128.0, (((128.0 - (x)) * chromaCorrect)))) |
| #define CHROMA_CORRECTION128D(x) ((x) >= 0 \ |
| ? Min(127.0, ((x) * chromaCorrect)) \ |
| : Max(-128.0, ((x) * chromaCorrect))) |
| |
| |
| void gst_colorspace_I420_to_rgb16 (GstColorspace * space, unsigned char *src, |
| unsigned char *dest); |
| void gst_colorspace_I420_to_rgb24 (GstColorspace * space, unsigned char *src, |
| unsigned char *dest); |
| void gst_colorspace_I420_to_rgb32 (GstColorspace * space, unsigned char *src, |
| unsigned char *dest); |
| #ifdef HAVE_LIBMMX |
| void gst_colorspace_I420_to_bgr16_mmx (GstColorspace * space, |
| unsigned char *src, unsigned char *dest); |
| void gst_colorspace_I420_to_bgr32_mmx (GstColorspace * space, |
| unsigned char *src, unsigned char *dest); |
| #endif |
| |
| void gst_colorspace_YV12_to_rgb16 (GstColorspace * space, unsigned char *src, |
| unsigned char *dest); |
| void gst_colorspace_YV12_to_rgb24 (GstColorspace * space, unsigned char *src, |
| unsigned char *dest); |
| void gst_colorspace_YV12_to_rgb32 (GstColorspace * space, unsigned char *src, |
| unsigned char *dest); |
| #ifdef HAVE_LIBMMX |
| void gst_colorspace_YV12_to_bgr16_mmx (GstColorspace * space, |
| unsigned char *src, unsigned char *dest); |
| void gst_colorspace_YV12_to_bgr32_mmx (GstColorspace * space, |
| unsigned char *src, unsigned char *dest); |
| #endif |
| |
| static void |
| gst_colorspace_yuv_to_rgb16 (GstColorspace * space, |
| unsigned char *out, |
| unsigned char *lum, |
| unsigned char *cr, unsigned char *cb, int cols, int rows); |
| static void |
| gst_colorspace_yuv_to_rgb24 (GstColorspace * space, |
| unsigned char *out, |
| unsigned char *lum, |
| unsigned char *cr, unsigned char *cb, int cols, int rows); |
| static void |
| gst_colorspace_yuv_to_rgb32 (GstColorspace * space, |
| unsigned char *out, |
| unsigned char *lum, |
| unsigned char *cr, unsigned char *cb, int cols, int rows); |
| #if 0 |
| 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 |
| 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); |
| extern 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 |
| #endif |
| |
| #define ROUND_UP_2(x) (((x)+1)&~1) |
| #define ROUND_UP_4(x) (((x)+3)&~3) |
| #define ROUND_UP_8(x) (((x)+7)&~7) |
| |
| |
| void |
| gst_colorspace_I420_to_rgb32 (GstColorspace * space, unsigned char *dest, |
| unsigned char *src) |
| { |
| unsigned char *src_U; |
| unsigned char *src_V; |
| |
| src_U = src + ROUND_UP_4 (space->width) * ROUND_UP_2 (space->height); |
| src_V = |
| src_U + ROUND_UP_8 (space->width) / 2 * ROUND_UP_2 (space->height) / 2; |
| |
| gst_colorspace_yuv_to_rgb32 (space, |
| dest, src, src_U, src_V, space->width, space->height); |
| } |
| |
| void |
| gst_colorspace_I420_to_rgb24 (GstColorspace * space, unsigned char *dest, |
| unsigned char *src) |
| { |
| unsigned char *src_U; |
| unsigned char *src_V; |
| |
| src_U = src + ROUND_UP_4 (space->width) * ROUND_UP_2 (space->height); |
| src_V = |
| src_U + ROUND_UP_8 (space->width) / 2 * ROUND_UP_2 (space->height) / 2; |
| |
| gst_colorspace_yuv_to_rgb24 (space, |
| dest, src, src_U, src_V, space->width, space->height); |
| } |
| |
| void |
| gst_colorspace_I420_to_rgb16 (GstColorspace * space, unsigned char *dest, |
| unsigned char *src) |
| { |
| unsigned char *src_U; |
| unsigned char *src_V; |
| |
| src_U = src + ROUND_UP_4 (space->width) * ROUND_UP_2 (space->height); |
| src_V = |
| src_U + ROUND_UP_8 (space->width) / 2 * ROUND_UP_2 (space->height) / 2; |
| |
| gst_colorspace_yuv_to_rgb16 (space, |
| dest, src, src_U, src_V, space->width, space->height); |
| } |
| |
| void |
| gst_colorspace_YV12_to_rgb32 (GstColorspace * space, unsigned char *dest, |
| unsigned char *src) |
| { |
| unsigned char *src_U; |
| unsigned char *src_V; |
| |
| src_V = src + ROUND_UP_4 (space->width) * ROUND_UP_2 (space->height); |
| src_U = |
| src_V + ROUND_UP_8 (space->width) / 2 * ROUND_UP_2 (space->height) / 2; |
| |
| gst_colorspace_yuv_to_rgb32 (space, |
| dest, src, src_U, src_V, space->width, space->height); |
| } |
| |
| void |
| gst_colorspace_YV12_to_rgb24 (GstColorspace * space, unsigned char *dest, |
| unsigned char *src) |
| { |
| unsigned char *src_U; |
| unsigned char *src_V; |
| |
| src_V = src + ROUND_UP_4 (space->width) * ROUND_UP_2 (space->height); |
| src_U = |
| src_V + ROUND_UP_8 (space->width) / 2 * ROUND_UP_2 (space->height) / 2; |
| |
| gst_colorspace_yuv_to_rgb24 (space, |
| dest, src, src_U, src_V, space->width, space->height); |
| } |
| |
| void |
| gst_colorspace_YV12_to_rgb16 (GstColorspace * space, unsigned char *dest, |
| unsigned char *src) |
| { |
| unsigned char *src_U; |
| unsigned char *src_V; |
| |
| src_V = src + ROUND_UP_4 (space->width) * ROUND_UP_2 (space->height); |
| src_U = |
| src_V + ROUND_UP_8 (space->width) / 2 * ROUND_UP_2 (space->height) / 2; |
| |
| gst_colorspace_yuv_to_rgb16 (space, |
| dest, src, src_U, src_V, space->width, space->height); |
| } |
| |
| #ifdef HAVE_LIBMMX |
| void |
| gst_colorspace_I420_to_bgr32_mmx (GstColorspace * space, unsigned char *src, |
| unsigned char *dest) |
| { |
| int size; |
| |
| GST_DEBUG ("gst_colorspace_I420_to_rgb32_mmx"); |
| |
| 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); |
| |
| } |
| |
| void |
| gst_colorspace_I420_to_bgr16_mmx (GstColorspace * space, unsigned char *src, |
| unsigned char *dest) |
| { |
| int size; |
| |
| GST_DEBUG ("gst_colorspace_I420_to_bgr16_mmx "); |
| |
| 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); |
| GST_DEBUG ("gst_colorspace_I420_to_bgr16_mmx done"); |
| |
| } |
| |
| void |
| gst_colorspace_YV12_to_bgr32_mmx (GstColorspace * space, unsigned char *src, |
| unsigned char *dest) |
| { |
| int size; |
| |
| GST_DEBUG ("gst_colorspace_YV12_to_rgb32_mmx"); |
| |
| size = space->width * space->height; |
| |
| gst_colorspace_yuv_to_bgr32_mmx (NULL, src, /* Y component */ |
| src + size + (size >> 2), /* cb component */ |
| src + size, /* cr component */ |
| dest, space->height, space->width); |
| |
| } |
| |
| void |
| gst_colorspace_YV12_to_bgr16_mmx (GstColorspace * space, unsigned char *src, |
| unsigned char *dest) |
| { |
| int size; |
| |
| GST_DEBUG ("gst_colorspace_YV12_to_bgr16_mmx "); |
| |
| size = space->width * space->height; |
| |
| gst_colorspace_yuv_to_bgr16_mmx (NULL, src, /* Y component */ |
| src + size + (size >> 2), /* cb component */ |
| src + size, /* cr component */ |
| dest, space->height, space->width); |
| GST_DEBUG ("gst_colorspace_YV12_to_bgr16_mmx done"); |
| |
| } |
| #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)); |
| } |
| |
| /* |
| * 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. |
| * |
| *-------------------------------------------------------------- |
| */ |
| |
| void |
| gst_colorspace_table_init (GstColorspace * space) |
| { |
| int i; |
| |
| for (i = 0; i < 256; i++) { |
| V_r_tab[i] = (0.419 / 0.299) * (i - 128); |
| V_g_tab[i] = -(0.299 / 0.419) * (i - 128); |
| U_g_tab[i] = -(0.114 / 0.331) * (i - 128); |
| U_b_tab[i] = (0.587 / 0.331) * (i - 128); |
| } |
| #if 0 |
| 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; |
| long depth = 32; |
| long red_mask = 0xff0000; |
| long green_mask = 0x00ff00; |
| long blue_mask = 0x0000ff; |
| |
| L_tab = space->L_tab = (int *) malloc (256 * sizeof (int)); |
| Cr_r_tab = space->Cr_r_tab = (int *) malloc (256 * sizeof (int)); |
| Cr_g_tab = space->Cr_g_tab = (int *) malloc (256 * sizeof (int)); |
| Cb_g_tab = space->Cb_g_tab = (int *) malloc (256 * sizeof (int)); |
| Cb_b_tab = space->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]; |
| } |
| |
| space->r_2_pix = r_2_pix_alloc + 256; |
| space->g_2_pix = g_2_pix_alloc + 256; |
| space->b_2_pix = b_2_pix_alloc + 256; |
| #endif |
| } |
| |
| static void |
| gst_colorspace_yuv_to_rgb32 (GstColorspace * space, |
| unsigned char *dest, |
| unsigned char *Y, unsigned char *U, unsigned char *V, int width, int height) |
| { |
| int x, y; |
| int src_rowstride; |
| int dest_rowstride; |
| |
| src_rowstride = ROUND_UP_4 (space->width); |
| dest_rowstride = width * 4; |
| for (y = 0; y < height; y++) { |
| for (x = 0; x < width; x++) { |
| dest[x * 4 + 0] = 0; |
| dest[x * 3 + 1] = CLAMP (Y[x] + V_r_tab[V[x / 2]], 0, 255); |
| dest[x * 3 + 2] = |
| CLAMP (Y[x] + U_g_tab[U[x / 2]] + V_g_tab[V[x / 2]], 0, 255); |
| dest[x * 3 + 3] = CLAMP (Y[x] + U_b_tab[U[x / 2]], 0, 255); |
| } |
| Y += src_rowstride; |
| dest += dest_rowstride; |
| if (y & 1) { |
| U += src_rowstride / 2; |
| V += src_rowstride / 2; |
| } |
| } |
| } |
| |
| static void |
| gst_colorspace_yuv_to_rgb24 (GstColorspace * space, |
| unsigned char *dest, |
| unsigned char *Y, unsigned char *U, unsigned char *V, int width, int height) |
| { |
| int x, y; |
| int src_rowstride; |
| int dest_rowstride; |
| |
| src_rowstride = ROUND_UP_4 (space->width); |
| dest_rowstride = ROUND_UP_4 (width * 3); |
| for (y = 0; y < height; y++) { |
| for (x = 0; x < width; x++) { |
| dest[x * 3 + 0] = CLAMP (Y[x] + V_r_tab[V[x / 2]], 0, 255); |
| dest[x * 3 + 1] = |
| CLAMP (Y[x] + U_g_tab[U[x / 2]] + V_g_tab[V[x / 2]], 0, 255); |
| dest[x * 3 + 2] = CLAMP (Y[x] + U_b_tab[U[x / 2]], 0, 255); |
| } |
| Y += src_rowstride; |
| dest += dest_rowstride; |
| if (y & 1) { |
| U += src_rowstride / 2; |
| V += src_rowstride / 2; |
| } |
| } |
| } |
| |
| static void |
| gst_colorspace_yuv_to_rgb16 (GstColorspace * space, |
| unsigned char *dest, |
| unsigned char *Y, unsigned char *U, unsigned char *V, int width, int height) |
| { |
| int x, y; |
| int src_rowstride; |
| int dest_rowstride; |
| int r, g, b; |
| |
| src_rowstride = ROUND_UP_4 (space->width); |
| dest_rowstride = ROUND_UP_4 (width * 2); |
| for (y = 0; y < height; y++) { |
| for (x = 0; x < width; x++) { |
| r = CLAMP (Y[x] + V_r_tab[V[x / 2]], 0, 255); |
| g = CLAMP (Y[x] + U_g_tab[U[x / 2]] + V_g_tab[V[x / 2]], 0, 255); |
| b = CLAMP (Y[x] + U_b_tab[U[x / 2]], 0, 255); |
| *(unsigned short *) (dest + x * 2) = |
| ((r & 0xf8) << 8) | ((g & 0xfc) << 3) | (b >> 3); |
| } |
| Y += src_rowstride; |
| dest += dest_rowstride; |
| if (y & 1) { |
| U += src_rowstride / 2; |
| V += src_rowstride / 2; |
| } |
| } |
| } |
| |
| #ifdef HAVE_LIBMMX |
| 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 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_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 *) cb, 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 *) cr, 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 |
