git.sesse.net Git - vlc/blob - modules/video_chroma/i420_rgb.c

   1 /*****************************************************************************
   2  * i420_rgb.c : YUV to bitmap RGB conversion module for vlc
   3  *****************************************************************************
   4  * Copyright (C) 2000, 2001, 2004, 2008 the VideoLAN team
   5  * $Id$
   6  *
   7  * Authors: Sam Hocevar <sam@zoy.org>
   8  *          Damien Fouilleul <damienf@videolan.org>
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
  23  *****************************************************************************/
  24
  25 /*****************************************************************************
  26  * Preamble
  27  *****************************************************************************/
  28
  29 #ifdef HAVE_CONFIG_H
  30 # include "config.h"
  31 #endif
  32
  33 #include <math.h>                                            /* exp(), pow() */
  34
  35 #include <vlc_common.h>
  36 #include <vlc_plugin.h>
  37 #include <vlc_filter.h>
  38 #include <vlc_vout.h>
  39
  40 #include "i420_rgb.h"
  41 #if defined (MODULE_NAME_IS_i420_rgb)
  42 #   include "i420_rgb_c.h"
  43 #endif
  44
  45 /*****************************************************************************
  46  * RGB2PIXEL: assemble RGB components to a pixel value, returns a uint32_t
  47  *****************************************************************************/
  48 #define RGB2PIXEL( p_filter, i_r, i_g, i_b )                 \
  49     (((((uint32_t)i_r) >> p_filter->fmt_out.video.i_rrshift) \
  50                        << p_filter->fmt_out.video.i_lrshift) \
  51    | ((((uint32_t)i_g) >> p_filter->fmt_out.video.i_rgshift) \
  52                        << p_filter->fmt_out.video.i_lgshift) \
  53    | ((((uint32_t)i_b) >> p_filter->fmt_out.video.i_rbshift) \
  54                        << p_filter->fmt_out.video.i_lbshift))
  55
  56 /*****************************************************************************
  57  * Local and extern prototypes.
  58  *****************************************************************************/
  59 static int  Activate   ( vlc_object_t * );
  60 static void Deactivate ( vlc_object_t * );
  61
  62 #if defined (MODULE_NAME_IS_i420_rgb)
  63 static void SetGammaTable       ( int *pi_table, double f_gamma );
  64 static void SetYUV              ( filter_t * );
  65 static void Set8bppPalette      ( filter_t *, uint8_t * );
  66 #endif
  67
  68 /*****************************************************************************
  69  * Module descriptor.
  70  *****************************************************************************/
  71 vlc_module_begin ()
  72 #if defined (MODULE_NAME_IS_i420_rgb)
  73     set_description( N_("I420,IYUV,YV12 to "
  74                        "RGB2,RV15,RV16,RV24,RV32 conversions") )
  75     set_capability( "video filter2", 80 )
  76 #elif defined (MODULE_NAME_IS_i420_rgb_mmx)
  77     set_description( N_( "MMX I420,IYUV,YV12 to "
  78                         "RV15,RV16,RV24,RV32 conversions") )
  79     set_capability( "video filter2", 100 )
  80     add_requirement( MMX )
  81 #elif defined (MODULE_NAME_IS_i420_rgb_sse2)
  82     set_description( N_( "SSE2 I420,IYUV,YV12 to "
  83                         "RV15,RV16,RV24,RV32 conversions") )
  84     set_capability( "video filter2", 120 )
  85     add_requirement( SSE2 )
  86 #endif
  87     set_callbacks( Activate, Deactivate )
  88 vlc_module_end ()
  89
  90 /*****************************************************************************
  91  * Activate: allocate a chroma function
  92  *****************************************************************************
  93  * This function allocates and initializes a chroma function
  94  *****************************************************************************/
  95 static int Activate( vlc_object_t *p_this )
  96 {
  97     filter_t *p_filter = (filter_t *)p_this;
  98 #if defined (MODULE_NAME_IS_i420_rgb)
  99     size_t i_tables_size;
 100 #endif
 101
 102     if( p_filter->fmt_out.video.i_width & 1
 103      || p_filter->fmt_out.video.i_height & 1 )
 104     {
 105         return VLC_EGENERIC;
 106     }
 107
 108     switch( p_filter->fmt_in.video.i_chroma )
 109     {
 110         case VLC_CODEC_YV12:
 111         case VLC_CODEC_I420:
 112             switch( p_filter->fmt_out.video.i_chroma )
 113             {
 114 #if defined (MODULE_NAME_IS_i420_rgb)
 115                 case VLC_CODEC_RGB8:
 116                     p_filter->pf_video_filter = I420_RGB8_Filter;
 117                     break;
 118 #endif
 119                 case VLC_CODEC_RGB15:
 120                 case VLC_CODEC_RGB16:
 121 #if ! defined (MODULE_NAME_IS_i420_rgb)
 122                     /* If we don't have support for the bitmasks, bail out */
 123                     if( ( p_filter->fmt_out.video.i_rmask == 0x7c00
 124                        && p_filter->fmt_out.video.i_gmask == 0x03e0
 125                        && p_filter->fmt_out.video.i_bmask == 0x001f ) )
 126                     {
 127                         /* R5G5B6 pixel format */
 128                         msg_Dbg(p_this, "RGB pixel format is R5G5B5");
 129                         p_filter->pf_video_filter = I420_R5G5B5_Filter;
 130                     }
 131                     else if( ( p_filter->fmt_out.video.i_rmask == 0xf800
 132                             && p_filter->fmt_out.video.i_gmask == 0x07e0
 133                             && p_filter->fmt_out.video.i_bmask == 0x001f ) )
 134                     {
 135                         /* R5G6B5 pixel format */
 136                         msg_Dbg(p_this, "RGB pixel format is R5G6B5");
 137                         p_filter->pf_video_filter = I420_R5G6B5_Filter;
 138                     }
 139                     else
 140                         return VLC_EGENERIC;
 141 #else
 142                     // generic C chroma converter */
 143                     p_filter->pf_video_filter = I420_RGB16_Filter;
 144 #endif
 145                     break;
 146
 147 #if 0
 148                 /* Hmmm, is there only X11 using 32bits per pixel for RV24 ? */
 149                 case VLC_CODEC_RGB24:
 150 #endif
 151
 152                 case VLC_CODEC_RGB32:
 153 #if ! defined (MODULE_NAME_IS_i420_rgb)
 154                     /* If we don't have support for the bitmasks, bail out */
 155                     if( p_filter->fmt_out.video.i_rmask == 0x00ff0000
 156                      && p_filter->fmt_out.video.i_gmask == 0x0000ff00
 157                      && p_filter->fmt_out.video.i_bmask == 0x000000ff )
 158                     {
 159                         /* A8R8G8B8 pixel format */
 160                         msg_Dbg(p_this, "RGB pixel format is A8R8G8B8");
 161                         p_filter->pf_video_filter = I420_A8R8G8B8_Filter;
 162                     }
 163                     else if( p_filter->fmt_out.video.i_rmask == 0xff000000
 164                           && p_filter->fmt_out.video.i_gmask == 0x00ff0000
 165                           && p_filter->fmt_out.video.i_bmask == 0x0000ff00 )
 166                     {
 167                         /* R8G8B8A8 pixel format */
 168                         msg_Dbg(p_this, "RGB pixel format is R8G8B8A8");
 169                         p_filter->pf_video_filter = I420_R8G8B8A8_Filter;
 170                     }
 171                     else if( p_filter->fmt_out.video.i_rmask == 0x0000ff00
 172                           && p_filter->fmt_out.video.i_gmask == 0x00ff0000
 173                           && p_filter->fmt_out.video.i_bmask == 0xff000000 )
 174                     {
 175                         /* B8G8R8A8 pixel format */
 176                         msg_Dbg(p_this, "RGB pixel format is B8G8R8A8");
 177                         p_filter->pf_video_filter = I420_B8G8R8A8_Filter;
 178                     }
 179                     else if( p_filter->fmt_out.video.i_rmask == 0x000000ff
 180                           && p_filter->fmt_out.video.i_gmask == 0x0000ff00
 181                           && p_filter->fmt_out.video.i_bmask == 0x00ff0000 )
 182                     {
 183                         /* A8B8G8R8 pixel format */
 184                         msg_Dbg(p_this, "RGB pixel format is A8B8G8R8");
 185                         p_filter->pf_video_filter = I420_A8B8G8R8_Filter;
 186                     }
 187                     else
 188                         return VLC_EGENERIC;
 189 #else
 190                     /* generic C chroma converter */
 191                     p_filter->pf_video_filter = I420_RGB32_Filter;
 192 #endif
 193                     break;
 194
 195                 default:
 196                     return VLC_EGENERIC;
 197             }
 198             break;
 199
 200         default:
 201             return VLC_EGENERIC;
 202     }
 203
 204     p_filter->p_sys = malloc( sizeof( filter_sys_t ) );
 205     if( p_filter->p_sys == NULL )
 206     {
 207         return VLC_EGENERIC;
 208     }
 209
 210     switch( p_filter->fmt_out.video.i_chroma )
 211     {
 212 #if defined (MODULE_NAME_IS_i420_rgb)
 213         case VLC_CODEC_RGB8:
 214             p_filter->p_sys->p_buffer = malloc( VOUT_MAX_WIDTH );
 215             break;
 216 #endif
 217
 218         case VLC_CODEC_RGB15:
 219         case VLC_CODEC_RGB16:
 220             p_filter->p_sys->p_buffer = malloc( VOUT_MAX_WIDTH * 2 );
 221             break;
 222
 223         case VLC_CODEC_RGB24:
 224         case VLC_CODEC_RGB32:
 225             p_filter->p_sys->p_buffer = malloc( VOUT_MAX_WIDTH * 4 );
 226             break;
 227
 228         default:
 229             p_filter->p_sys->p_buffer = NULL;
 230             break;
 231     }
 232
 233     if( p_filter->p_sys->p_buffer == NULL )
 234     {
 235         free( p_filter->p_sys );
 236         return VLC_EGENERIC;
 237     }
 238
 239     p_filter->p_sys->p_offset = malloc( p_filter->fmt_out.video.i_width
 240                     * ( ( p_filter->fmt_out.video.i_chroma
 241                            == VLC_CODEC_RGB8 ) ? 2 : 1 )
 242                     * sizeof( int ) );
 243     if( p_filter->p_sys->p_offset == NULL )
 244     {
 245         free( p_filter->p_sys->p_buffer );
 246         free( p_filter->p_sys );
 247         return VLC_EGENERIC;
 248     }
 249
 250 #if defined (MODULE_NAME_IS_i420_rgb)
 251     switch( p_filter->fmt_out.video.i_chroma )
 252     {
 253     case VLC_CODEC_RGB8:
 254         i_tables_size = sizeof( uint8_t ) * PALETTE_TABLE_SIZE;
 255         break;
 256     case VLC_CODEC_RGB15:
 257     case VLC_CODEC_RGB16:
 258         i_tables_size = sizeof( uint16_t ) * RGB_TABLE_SIZE;
 259         break;
 260     default: /* RV24, RV32 */
 261         i_tables_size = sizeof( uint32_t ) * RGB_TABLE_SIZE;
 262         break;
 263     }
 264
 265     p_filter->p_sys->p_base = malloc( i_tables_size );
 266     if( p_filter->p_sys->p_base == NULL )
 267     {
 268         free( p_filter->p_sys->p_offset );
 269         free( p_filter->p_sys->p_buffer );
 270         free( p_filter->p_sys );
 271         return -1;
 272     }
 273
 274     SetYUV( p_filter );
 275 #endif
 276
 277     return 0;
 278 }
 279
 280 /*****************************************************************************
 281  * Deactivate: free the chroma function
 282  *****************************************************************************
 283  * This function frees the previously allocated chroma function
 284  *****************************************************************************/
 285 static void Deactivate( vlc_object_t *p_this )
 286 {
 287     filter_t *p_filter = (filter_t *)p_this;
 288
 289 #if defined (MODULE_NAME_IS_i420_rgb)
 290     free( p_filter->p_sys->p_base );
 291 #endif
 292     free( p_filter->p_sys->p_offset );
 293     free( p_filter->p_sys->p_buffer );
 294     free( p_filter->p_sys );
 295 }
 296
 297 #if defined (MODULE_NAME_IS_i420_rgb)
 298 VIDEO_FILTER_WRAPPER( I420_RGB8 )
 299 VIDEO_FILTER_WRAPPER( I420_RGB16 )
 300 VIDEO_FILTER_WRAPPER( I420_RGB32 )
 301 #else
 302 VIDEO_FILTER_WRAPPER( I420_R5G5B5 )
 303 VIDEO_FILTER_WRAPPER( I420_R5G6B5 )
 304 VIDEO_FILTER_WRAPPER( I420_A8R8G8B8 )
 305 VIDEO_FILTER_WRAPPER( I420_R8G8B8A8 )
 306 VIDEO_FILTER_WRAPPER( I420_B8G8R8A8 )
 307 VIDEO_FILTER_WRAPPER( I420_A8B8G8R8 )
 308 #endif
 309
 310 #if defined (MODULE_NAME_IS_i420_rgb)
 311 /*****************************************************************************
 312  * SetGammaTable: return intensity table transformed by gamma curve.
 313  *****************************************************************************
 314  * pi_table is a table of 256 entries from 0 to 255.
 315  *****************************************************************************/
 316 static void SetGammaTable( int *pi_table, double f_gamma )
 317 {
 318     int i_y;                                               /* base intensity */
 319
 320     /* Use exp(gamma) instead of gamma */
 321     f_gamma = exp( f_gamma );
 322
 323     /* Build gamma table */
 324     for( i_y = 0; i_y < 256; i_y++ )
 325     {
 326         pi_table[ i_y ] = (int)( pow( (double)i_y / 256, f_gamma ) * 256 );
 327     }
 328 }
 329
 330 /*****************************************************************************
 331  * SetYUV: compute tables and set function pointers
 332  *****************************************************************************/
 333 static void SetYUV( filter_t *p_filter )
 334 {
 335     int          pi_gamma[256];                               /* gamma table */
 336     volatile int i_index;                                 /* index in tables */
 337                    /* We use volatile here to work around a strange gcc-3.3.4
 338                     * optimization bug */
 339
 340     /* Build gamma table */
 341     SetGammaTable( pi_gamma, 0 ); //p_filter/*FIXME wasn't used anywhere anyway*/->f_gamma );
 342
 343     /*
 344      * Set pointers and build YUV tables
 345      */
 346
 347     /* Color: build red, green and blue tables */
 348     switch( p_filter->fmt_out.video.i_chroma )
 349     {
 350     case VLC_CODEC_RGB8:
 351         p_filter->p_sys->p_rgb8 = (uint8_t *)p_filter->p_sys->p_base;
 352         Set8bppPalette( p_filter, p_filter->p_sys->p_rgb8 );
 353         break;
 354
 355     case VLC_CODEC_RGB15:
 356     case VLC_CODEC_RGB16:
 357         p_filter->p_sys->p_rgb16 = (uint16_t *)p_filter->p_sys->p_base;
 358         for( i_index = 0; i_index < RED_MARGIN; i_index++ )
 359         {
 360             p_filter->p_sys->p_rgb16[RED_OFFSET - RED_MARGIN + i_index] = RGB2PIXEL( p_filter, pi_gamma[0], 0, 0 );
 361             p_filter->p_sys->p_rgb16[RED_OFFSET + 256 + i_index] =        RGB2PIXEL( p_filter, pi_gamma[255], 0, 0 );
 362         }
 363         for( i_index = 0; i_index < GREEN_MARGIN; i_index++ )
 364         {
 365             p_filter->p_sys->p_rgb16[GREEN_OFFSET - GREEN_MARGIN + i_index] = RGB2PIXEL( p_filter, 0, pi_gamma[0], 0 );
 366             p_filter->p_sys->p_rgb16[GREEN_OFFSET + 256 + i_index] =          RGB2PIXEL( p_filter, 0, pi_gamma[255], 0 );
 367         }
 368         for( i_index = 0; i_index < BLUE_MARGIN; i_index++ )
 369         {
 370             p_filter->p_sys->p_rgb16[BLUE_OFFSET - BLUE_MARGIN + i_index] = RGB2PIXEL( p_filter, 0, 0, pi_gamma[0] );
 371             p_filter->p_sys->p_rgb16[BLUE_OFFSET + BLUE_MARGIN + i_index] = RGB2PIXEL( p_filter, 0, 0, pi_gamma[255] );
 372         }
 373         for( i_index = 0; i_index < 256; i_index++ )
 374         {
 375             p_filter->p_sys->p_rgb16[RED_OFFSET + i_index] =   RGB2PIXEL( p_filter, pi_gamma[ i_index ], 0, 0 );
 376             p_filter->p_sys->p_rgb16[GREEN_OFFSET + i_index] = RGB2PIXEL( p_filter, 0, pi_gamma[ i_index ], 0 );
 377             p_filter->p_sys->p_rgb16[BLUE_OFFSET + i_index] =  RGB2PIXEL( p_filter, 0, 0, pi_gamma[ i_index ] );
 378         }
 379         break;
 380
 381     case VLC_CODEC_RGB24:
 382     case VLC_CODEC_RGB32:
 383         p_filter->p_sys->p_rgb32 = (uint32_t *)p_filter->p_sys->p_base;
 384         for( i_index = 0; i_index < RED_MARGIN; i_index++ )
 385         {
 386             p_filter->p_sys->p_rgb32[RED_OFFSET - RED_MARGIN + i_index] = RGB2PIXEL( p_filter, pi_gamma[0], 0, 0 );
 387             p_filter->p_sys->p_rgb32[RED_OFFSET + 256 + i_index] =        RGB2PIXEL( p_filter, pi_gamma[255], 0, 0 );
 388         }
 389         for( i_index = 0; i_index < GREEN_MARGIN; i_index++ )
 390         {
 391             p_filter->p_sys->p_rgb32[GREEN_OFFSET - GREEN_MARGIN + i_index] = RGB2PIXEL( p_filter, 0, pi_gamma[0], 0 );
 392             p_filter->p_sys->p_rgb32[GREEN_OFFSET + 256 + i_index] =          RGB2PIXEL( p_filter, 0, pi_gamma[255], 0 );
 393         }
 394         for( i_index = 0; i_index < BLUE_MARGIN; i_index++ )
 395         {
 396             p_filter->p_sys->p_rgb32[BLUE_OFFSET - BLUE_MARGIN + i_index] = RGB2PIXEL( p_filter, 0, 0, pi_gamma[0] );
 397             p_filter->p_sys->p_rgb32[BLUE_OFFSET + BLUE_MARGIN + i_index] = RGB2PIXEL( p_filter, 0, 0, pi_gamma[255] );
 398         }
 399         for( i_index = 0; i_index < 256; i_index++ )
 400         {
 401             p_filter->p_sys->p_rgb32[RED_OFFSET + i_index] =   RGB2PIXEL( p_filter, pi_gamma[ i_index ], 0, 0 );
 402             p_filter->p_sys->p_rgb32[GREEN_OFFSET + i_index] = RGB2PIXEL( p_filter, 0, pi_gamma[ i_index ], 0 );
 403             p_filter->p_sys->p_rgb32[BLUE_OFFSET + i_index] =  RGB2PIXEL( p_filter, 0, 0, pi_gamma[ i_index ] );
 404         }
 405         break;
 406     }
 407 }
 408
 409 static void Set8bppPalette( filter_t *p_filter, uint8_t *p_rgb8 )
 410 {
 411     #define CLIP( x ) ( ((x < 0) ? 0 : (x > 255) ? 255 : x) << 8 )
 412
 413     int y,u,v;
 414     int r,g,b;
 415     int i = 0, j = 0;
 416     uint16_t *p_cmap_r = p_filter->p_sys->p_rgb_r;
 417     uint16_t *p_cmap_g = p_filter->p_sys->p_rgb_g;
 418     uint16_t *p_cmap_b = p_filter->p_sys->p_rgb_b;
 419
 420     unsigned char p_lookup[PALETTE_TABLE_SIZE];
 421
 422     /* This loop calculates the intersection of an YUV box and the RGB cube. */
 423     for ( y = 0; y <= 256; y += 16, i += 128 - 81 )
 424     {
 425         for ( u = 0; u <= 256; u += 32 )
 426         {
 427             for ( v = 0; v <= 256; v += 32 )
 428             {
 429                 r = y + ( (V_RED_COEF*(v-128)) >> SHIFT );
 430                 g = y + ( (U_GREEN_COEF*(u-128)
 431                          + V_GREEN_COEF*(v-128)) >> SHIFT );
 432                 b = y + ( (U_BLUE_COEF*(u-128)) >> SHIFT );
 433
 434                 if( r >= 0x00 && g >= 0x00 && b >= 0x00
 435                         && r <= 0xff && g <= 0xff && b <= 0xff )
 436                 {
 437                     /* This one should never happen unless someone
 438                      * fscked up my code */
 439                     if( j == 256 )
 440                     {
 441                         msg_Err( p_filter, "no colors left in palette" );
 442                         break;
 443                     }
 444
 445                     /* Clip the colors */
 446                     p_cmap_r[ j ] = CLIP( r );
 447                     p_cmap_g[ j ] = CLIP( g );
 448                     p_cmap_b[ j ] = CLIP( b );
 449
 450 #if 0
 451             printf("+++Alloc RGB cmap %d (%d, %d, %d)\n", j,
 452                p_cmap_r[ j ] >>8, p_cmap_g[ j ] >>8,
 453                p_cmap_b[ j ] >>8);
 454 #endif
 455
 456                     /* Allocate color */
 457                     p_lookup[ i ] = 1;
 458                     p_rgb8[ i++ ] = j;
 459                     j++;
 460                 }
 461                 else
 462                 {
 463                     p_lookup[ i ] = 0;
 464                     p_rgb8[ i++ ] = 0;
 465                 }
 466             }
 467         }
 468     }
 469
 470     /* The colors have been allocated, we can set the palette */
 471     /* FIXME FIXME FIXME FIXME FIXME FIXME FIXME FIXME FIXME
 472     p_filter->fmt_out.video.pf_setpalette( p_filter, p_cmap_r, p_cmap_g, p_cmap_b );*/
 473
 474 #if 0
 475     /* There will eventually be a way to know which colors
 476      * couldn't be allocated and try to find a replacement */
 477     p_vout->i_white_pixel = 0xff;
 478     p_vout->i_black_pixel = 0x00;
 479     p_vout->i_gray_pixel = 0x44;
 480     p_vout->i_blue_pixel = 0x3b;
 481 #endif
 482
 483     /* This loop allocates colors that got outside the RGB cube */
 484     for ( i = 0, y = 0; y <= 256; y += 16, i += 128 - 81 )
 485     {
 486         for ( u = 0; u <= 256; u += 32 )
 487         {
 488             for ( v = 0; v <= 256; v += 32, i++ )
 489             {
 490                 int u2, v2, dist, mindist = 100000000;
 491
 492                 if( p_lookup[ i ] || y == 0 )
 493                 {
 494                     continue;
 495                 }
 496
 497                 /* Heavy. yeah. */
 498                 for( u2 = 0; u2 <= 256; u2 += 32 )
 499                 {
 500                     for( v2 = 0; v2 <= 256; v2 += 32 )
 501                     {
 502                         j = ((y>>4)<<7) + (u2>>5)*9 + (v2>>5);
 503                         dist = (u-u2)*(u-u2) + (v-v2)*(v-v2);
 504
 505                         /* Find the nearest color */
 506                         if( p_lookup[ j ] && dist < mindist )
 507                         {
 508                             p_rgb8[ i ] = p_rgb8[ j ];
 509                             mindist = dist;
 510                         }
 511
 512                         j -= 128;
 513
 514                         /* Find the nearest color */
 515                         if( p_lookup[ j ] && dist + 128 < mindist )
 516                         {
 517                             p_rgb8[ i ] = p_rgb8[ j ];
 518                             mindist = dist + 128;
 519                         }
 520                     }
 521                 }
 522             }
 523         }
 524     }
 525 }
 526
 527 #endif
 528