git.sesse.net Git - ffmpeg/blob - libswscale/yuv2rgb.c

   1 /*
   2  * software YUV to RGB converter
   3  *
   4  * Copyright (C) 2009 Konstantin Shishkov
   5  *
   6  * 1,4,8bpp support and context / deglobalize stuff
   7  * by Michael Niedermayer (michaelni@gmx.at)
   8  *
   9  * This file is part of FFmpeg.
  10  *
  11  * FFmpeg is free software; you can redistribute it and/or
  12  * modify it under the terms of the GNU Lesser General Public
  13  * License as published by the Free Software Foundation; either
  14  * version 2.1 of the License, or (at your option) any later version.
  15  *
  16  * FFmpeg is distributed in the hope that it will be useful,
  17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  19  * Lesser General Public License for more details.
  20  *
  21  * You should have received a copy of the GNU Lesser General Public
  22  * License along with FFmpeg; if not, write to the Free Software
  23  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  24  */
  25
  26 #include <stdio.h>
  27 #include <stdlib.h>
  28 #include <inttypes.h>
  29 #include <assert.h>
  30
  31 #include "libavutil/cpu.h"
  32 #include "libavutil/bswap.h"
  33 #include "config.h"
  34 #include "rgb2rgb.h"
  35 #include "swscale.h"
  36 #include "swscale_internal.h"
  37 #include "libavutil/pixdesc.h"
  38
  39 extern const uint8_t dither_4x4_16[4][8];
  40 extern const uint8_t dither_8x8_32[8][8];
  41 extern const uint8_t dither_8x8_73[8][8];
  42 extern const uint8_t dither_8x8_220[8][8];
  43
  44 const int32_t ff_yuv2rgb_coeffs[8][4] = {
  45     { 117504, 138453, 13954, 34903 }, /* no sequence_display_extension */
  46     { 117504, 138453, 13954, 34903 }, /* ITU-R Rec. 709 (1990) */
  47     { 104597, 132201, 25675, 53279 }, /* unspecified */
  48     { 104597, 132201, 25675, 53279 }, /* reserved */
  49     { 104448, 132798, 24759, 53109 }, /* FCC */
  50     { 104597, 132201, 25675, 53279 }, /* ITU-R Rec. 624-4 System B, G */
  51     { 104597, 132201, 25675, 53279 }, /* SMPTE 170M */
  52     { 117579, 136230, 16907, 35559 }  /* SMPTE 240M (1987) */
  53 };
  54
  55 const int *sws_getCoefficients(int colorspace)
  56 {
  57     if (colorspace > 7 || colorspace < 0)
  58         colorspace = SWS_CS_DEFAULT;
  59     return ff_yuv2rgb_coeffs[colorspace];
  60 }
  61
  62 #define LOADCHROMA(i)                               \
  63     U = pu[i];                                      \
  64     V = pv[i];                                      \
  65     r = (void *)c->table_rV[V+YUVRGB_TABLE_HEADROOM];                     \
  66     g = (void *)(c->table_gU[U+YUVRGB_TABLE_HEADROOM] + c->table_gV[V+YUVRGB_TABLE_HEADROOM]);  \
  67     b = (void *)c->table_bU[U+YUVRGB_TABLE_HEADROOM];
  68
  69 #define PUTRGB(dst, src, i)                         \
  70     Y              = src[2 * i];                    \
  71     dst[2 * i]     = r[Y] + g[Y] + b[Y];            \
  72     Y              = src[2 * i + 1];                \
  73     dst[2 * i + 1] = r[Y] + g[Y] + b[Y];
  74
  75 #define PUTRGB24(dst, src, i)                       \
  76     Y              = src[2 * i];                    \
  77     dst[6 * i + 0] = r[Y];                          \
  78     dst[6 * i + 1] = g[Y];                          \
  79     dst[6 * i + 2] = b[Y];                          \
  80     Y              = src[2 * i + 1];                \
  81     dst[6 * i + 3] = r[Y];                          \
  82     dst[6 * i + 4] = g[Y];                          \
  83     dst[6 * i + 5] = b[Y];
  84
  85 #define PUTBGR24(dst, src, i)                       \
  86     Y              = src[2 * i];                    \
  87     dst[6 * i + 0] = b[Y];                          \
  88     dst[6 * i + 1] = g[Y];                          \
  89     dst[6 * i + 2] = r[Y];                          \
  90     Y              = src[2 * i + 1];                \
  91     dst[6 * i + 3] = b[Y];                          \
  92     dst[6 * i + 4] = g[Y];                          \
  93     dst[6 * i + 5] = r[Y];
  94
  95 #define PUTRGBA(dst, ysrc, asrc, i, s)                                  \
  96     Y              = ysrc[2 * i];                                       \
  97     dst[2 * i]     = r[Y] + g[Y] + b[Y] + (asrc[2 * i]     << s);       \
  98     Y              = ysrc[2 * i + 1];                                   \
  99     dst[2 * i + 1] = r[Y] + g[Y] + b[Y] + (asrc[2 * i + 1] << s);
 100
 101 #define PUTRGB48(dst, src, i)                       \
 102     Y                = src[ 2 * i];                 \
 103     dst[12 * i +  0] = dst[12 * i +  1] = r[Y];     \
 104     dst[12 * i +  2] = dst[12 * i +  3] = g[Y];     \
 105     dst[12 * i +  4] = dst[12 * i +  5] = b[Y];     \
 106     Y                = src[ 2 * i + 1];             \
 107     dst[12 * i +  6] = dst[12 * i +  7] = r[Y];     \
 108     dst[12 * i +  8] = dst[12 * i +  9] = g[Y];     \
 109     dst[12 * i + 10] = dst[12 * i + 11] = b[Y];
 110
 111 #define PUTBGR48(dst, src, i)                       \
 112     Y                = src[2 * i];                  \
 113     dst[12 * i +  0] = dst[12 * i +  1] = b[Y];     \
 114     dst[12 * i +  2] = dst[12 * i +  3] = g[Y];     \
 115     dst[12 * i +  4] = dst[12 * i +  5] = r[Y];     \
 116     Y                = src[2  * i +  1];            \
 117     dst[12 * i +  6] = dst[12 * i +  7] = b[Y];     \
 118     dst[12 * i +  8] = dst[12 * i +  9] = g[Y];     \
 119     dst[12 * i + 10] = dst[12 * i + 11] = r[Y];
 120
 121 #define YUV2RGBFUNC(func_name, dst_type, alpha)                             \
 122     static int func_name(SwsContext *c, const uint8_t *src[],               \
 123                          int srcStride[], int srcSliceY, int srcSliceH,     \
 124                          uint8_t *dst[], int dstStride[])                   \
 125     {                                                                       \
 126         int y;                                                              \
 127                                                                             \
 128         if (!alpha && c->srcFormat == PIX_FMT_YUV422P) {                    \
 129             srcStride[1] *= 2;                                              \
 130             srcStride[2] *= 2;                                              \
 131         }                                                                   \
 132         for (y = 0; y < srcSliceH; y += 2) {                                \
 133             dst_type *dst_1 =                                               \
 134                 (dst_type *)(dst[0] + (y + srcSliceY)     * dstStride[0]);  \
 135             dst_type *dst_2 =                                               \
 136                 (dst_type *)(dst[0] + (y + srcSliceY + 1) * dstStride[0]);  \
 137             dst_type av_unused *r, *g, *b;                                  \
 138             const uint8_t *py_1 = src[0] +  y       * srcStride[0];         \
 139             const uint8_t *py_2 = py_1   +            srcStride[0];         \
 140             const uint8_t *pu   = src[1] + (y >> 1) * srcStride[1];         \
 141             const uint8_t *pv   = src[2] + (y >> 1) * srcStride[2];         \
 142             const uint8_t av_unused *pa_1, *pa_2;                           \
 143             unsigned int h_size = c->dstW >> 3;                             \
 144             if (alpha) {                                                    \
 145                 pa_1 = src[3] + y * srcStride[3];                           \
 146                 pa_2 = pa_1   +     srcStride[3];                           \
 147             }                                                               \
 148             while (h_size--) {                                              \
 149                 int av_unused U, V, Y;                                      \
 150
 151 #define ENDYUV2RGBLINE(dst_delta)                   \
 152     pu    += 4;                                     \
 153     pv    += 4;                                     \
 154     py_1  += 8;                                     \
 155     py_2  += 8;                                     \
 156     dst_1 += dst_delta;                             \
 157     dst_2 += dst_delta;                             \
 158     }                                               \
 159     if (c->dstW & 4) {                              \
 160         int av_unused Y, U, V;                      \
 161
 162 #define ENDYUV2RGBFUNC()                            \
 163             }                                       \
 164         }                                           \
 165         return srcSliceH;                           \
 166     }
 167
 168 #define CLOSEYUV2RGBFUNC(dst_delta)                 \
 169     ENDYUV2RGBLINE(dst_delta)                       \
 170     ENDYUV2RGBFUNC()
 171
 172 YUV2RGBFUNC(yuv2rgb_c_48, uint8_t, 0)
 173     LOADCHROMA(0);
 174     PUTRGB48(dst_1, py_1, 0);
 175     PUTRGB48(dst_2, py_2, 0);
 176
 177     LOADCHROMA(1);
 178     PUTRGB48(dst_2, py_2, 1);
 179     PUTRGB48(dst_1, py_1, 1);
 180
 181     LOADCHROMA(2);
 182     PUTRGB48(dst_1, py_1, 2);
 183     PUTRGB48(dst_2, py_2, 2);
 184
 185     LOADCHROMA(3);
 186     PUTRGB48(dst_2, py_2, 3);
 187     PUTRGB48(dst_1, py_1, 3);
 188 ENDYUV2RGBLINE(48)
 189     LOADCHROMA(0);
 190     PUTRGB48(dst_1, py_1, 0);
 191     PUTRGB48(dst_2, py_2, 0);
 192
 193     LOADCHROMA(1);
 194     PUTRGB48(dst_2, py_2, 1);
 195     PUTRGB48(dst_1, py_1, 1);
 196 ENDYUV2RGBFUNC()
 197
 198 YUV2RGBFUNC(yuv2rgb_c_bgr48, uint8_t, 0)
 199     LOADCHROMA(0);
 200     PUTBGR48(dst_1, py_1, 0);
 201     PUTBGR48(dst_2, py_2, 0);
 202
 203     LOADCHROMA(1);
 204     PUTBGR48(dst_2, py_2, 1);
 205     PUTBGR48(dst_1, py_1, 1);
 206
 207     LOADCHROMA(2);
 208     PUTBGR48(dst_1, py_1, 2);
 209     PUTBGR48(dst_2, py_2, 2);
 210
 211     LOADCHROMA(3);
 212     PUTBGR48(dst_2, py_2, 3);
 213     PUTBGR48(dst_1, py_1, 3);
 214 ENDYUV2RGBLINE(48)
 215     LOADCHROMA(0);
 216     PUTBGR48(dst_1, py_1, 0);
 217     PUTBGR48(dst_2, py_2, 0);
 218
 219     LOADCHROMA(1);
 220     PUTBGR48(dst_2, py_2, 1);
 221     PUTBGR48(dst_1, py_1, 1);
 222 ENDYUV2RGBFUNC()
 223
 224 YUV2RGBFUNC(yuv2rgb_c_32, uint32_t, 0)
 225     LOADCHROMA(0);
 226     PUTRGB(dst_1, py_1, 0);
 227     PUTRGB(dst_2, py_2, 0);
 228
 229     LOADCHROMA(1);
 230     PUTRGB(dst_2, py_2, 1);
 231     PUTRGB(dst_1, py_1, 1);
 232
 233     LOADCHROMA(2);
 234     PUTRGB(dst_1, py_1, 2);
 235     PUTRGB(dst_2, py_2, 2);
 236
 237     LOADCHROMA(3);
 238     PUTRGB(dst_2, py_2, 3);
 239     PUTRGB(dst_1, py_1, 3);
 240 ENDYUV2RGBLINE(8)
 241     LOADCHROMA(0);
 242     PUTRGB(dst_1, py_1, 0);
 243     PUTRGB(dst_2, py_2, 0);
 244
 245     LOADCHROMA(1);
 246     PUTRGB(dst_2, py_2, 1);
 247     PUTRGB(dst_1, py_1, 1);
 248 ENDYUV2RGBFUNC()
 249
 250 YUV2RGBFUNC(yuva2rgba_c, uint32_t, 1)
 251     LOADCHROMA(0);
 252     PUTRGBA(dst_1, py_1, pa_1, 0, 24);
 253     PUTRGBA(dst_2, py_2, pa_2, 0, 24);
 254
 255     LOADCHROMA(1);
 256     PUTRGBA(dst_2, py_2, pa_1, 1, 24);
 257     PUTRGBA(dst_1, py_1, pa_2, 1, 24);
 258
 259     LOADCHROMA(2);
 260     PUTRGBA(dst_1, py_1, pa_1, 2, 24);
 261     PUTRGBA(dst_2, py_2, pa_2, 2, 24);
 262
 263     LOADCHROMA(3);
 264     PUTRGBA(dst_2, py_2, pa_1, 3, 24);
 265     PUTRGBA(dst_1, py_1, pa_2, 3, 24);
 266     pa_1 += 8; \
 267     pa_2 += 8; \
 268 ENDYUV2RGBLINE(8)
 269     LOADCHROMA(0);
 270     PUTRGBA(dst_1, py_1, pa_1, 0, 24);
 271     PUTRGBA(dst_2, py_2, pa_2, 0, 24);
 272
 273     LOADCHROMA(1);
 274     PUTRGBA(dst_2, py_2, pa_1, 1, 24);
 275     PUTRGBA(dst_1, py_1, pa_2, 1, 24);
 276 ENDYUV2RGBFUNC()
 277
 278 YUV2RGBFUNC(yuva2argb_c, uint32_t, 1)
 279     LOADCHROMA(0);
 280     PUTRGBA(dst_1, py_1, pa_1, 0, 0);
 281     PUTRGBA(dst_2, py_2, pa_2, 0, 0);
 282
 283     LOADCHROMA(1);
 284     PUTRGBA(dst_2, py_2, pa_2, 1, 0);
 285     PUTRGBA(dst_1, py_1, pa_1, 1, 0);
 286
 287     LOADCHROMA(2);
 288     PUTRGBA(dst_1, py_1, pa_1, 2, 0);
 289     PUTRGBA(dst_2, py_2, pa_2, 2, 0);
 290
 291     LOADCHROMA(3);
 292     PUTRGBA(dst_2, py_2, pa_2, 3, 0);
 293     PUTRGBA(dst_1, py_1, pa_1, 3, 0);
 294     pa_1 += 8; \
 295     pa_2 += 8; \
 296 ENDYUV2RGBLINE(8)
 297     LOADCHROMA(0);
 298     PUTRGBA(dst_1, py_1, pa_1, 0, 0);
 299     PUTRGBA(dst_2, py_2, pa_2, 0, 0);
 300
 301     LOADCHROMA(1);
 302     PUTRGBA(dst_2, py_2, pa_2, 1, 0);
 303     PUTRGBA(dst_1, py_1, pa_1, 1, 0);
 304 ENDYUV2RGBFUNC()
 305
 306 YUV2RGBFUNC(yuv2rgb_c_24_rgb, uint8_t, 0)
 307     LOADCHROMA(0);
 308     PUTRGB24(dst_1, py_1, 0);
 309     PUTRGB24(dst_2, py_2, 0);
 310
 311     LOADCHROMA(1);
 312     PUTRGB24(dst_2, py_2, 1);
 313     PUTRGB24(dst_1, py_1, 1);
 314
 315     LOADCHROMA(2);
 316     PUTRGB24(dst_1, py_1, 2);
 317     PUTRGB24(dst_2, py_2, 2);
 318
 319     LOADCHROMA(3);
 320     PUTRGB24(dst_2, py_2, 3);
 321     PUTRGB24(dst_1, py_1, 3);
 322 ENDYUV2RGBLINE(24)
 323     LOADCHROMA(0);
 324     PUTRGB24(dst_1, py_1, 0);
 325     PUTRGB24(dst_2, py_2, 0);
 326
 327     LOADCHROMA(1);
 328     PUTRGB24(dst_2, py_2, 1);
 329     PUTRGB24(dst_1, py_1, 1);
 330 ENDYUV2RGBFUNC()
 331
 332 // only trivial mods from yuv2rgb_c_24_rgb
 333 YUV2RGBFUNC(yuv2rgb_c_24_bgr, uint8_t, 0)
 334     LOADCHROMA(0);
 335     PUTBGR24(dst_1, py_1, 0);
 336     PUTBGR24(dst_2, py_2, 0);
 337
 338     LOADCHROMA(1);
 339     PUTBGR24(dst_2, py_2, 1);
 340     PUTBGR24(dst_1, py_1, 1);
 341
 342     LOADCHROMA(2);
 343     PUTBGR24(dst_1, py_1, 2);
 344     PUTBGR24(dst_2, py_2, 2);
 345
 346     LOADCHROMA(3);
 347     PUTBGR24(dst_2, py_2, 3);
 348     PUTBGR24(dst_1, py_1, 3);
 349 ENDYUV2RGBLINE(24)
 350     LOADCHROMA(0);
 351     PUTBGR24(dst_1, py_1, 0);
 352     PUTBGR24(dst_2, py_2, 0);
 353
 354     LOADCHROMA(1);
 355     PUTBGR24(dst_2, py_2, 1);
 356     PUTBGR24(dst_1, py_1, 1);
 357 ENDYUV2RGBFUNC()
 358
 359 // This is exactly the same code as yuv2rgb_c_32 except for the types of
 360 // r, g, b, dst_1, dst_2
 361 YUV2RGBFUNC(yuv2rgb_c_16, uint16_t, 0)
 362     LOADCHROMA(0);
 363     PUTRGB(dst_1, py_1, 0);
 364     PUTRGB(dst_2, py_2, 0);
 365
 366     LOADCHROMA(1);
 367     PUTRGB(dst_2, py_2, 1);
 368     PUTRGB(dst_1, py_1, 1);
 369
 370     LOADCHROMA(2);
 371     PUTRGB(dst_1, py_1, 2);
 372     PUTRGB(dst_2, py_2, 2);
 373
 374     LOADCHROMA(3);
 375     PUTRGB(dst_2, py_2, 3);
 376     PUTRGB(dst_1, py_1, 3);
 377 CLOSEYUV2RGBFUNC(8)
 378
 379 // r, g, b, dst_1, dst_2
 380 YUV2RGBFUNC(yuv2rgb_c_12_ordered_dither, uint16_t, 0)
 381     const uint8_t *d16 = dither_4x4_16[y & 3];
 382
 383 #define PUTRGB12(dst, src, i, o)                    \
 384     Y              = src[2 * i];                    \
 385     dst[2 * i]     = r[Y + d16[0 + o]] +            \
 386                      g[Y + d16[0 + o]] +            \
 387                      b[Y + d16[0 + o]];             \
 388     Y              = src[2 * i + 1];                \
 389     dst[2 * i + 1] = r[Y + d16[1 + o]] +            \
 390                      g[Y + d16[1 + o]] +            \
 391                      b[Y + d16[1 + o]];
 392
 393     LOADCHROMA(0);
 394     PUTRGB12(dst_1, py_1, 0, 0);
 395     PUTRGB12(dst_2, py_2, 0, 0 + 8);
 396
 397     LOADCHROMA(1);
 398     PUTRGB12(dst_2, py_2, 1, 2 + 8);
 399     PUTRGB12(dst_1, py_1, 1, 2);
 400
 401     LOADCHROMA(2);
 402     PUTRGB12(dst_1, py_1, 2, 4);
 403     PUTRGB12(dst_2, py_2, 2, 4 + 8);
 404
 405     LOADCHROMA(3);
 406     PUTRGB12(dst_2, py_2, 3, 6 + 8);
 407     PUTRGB12(dst_1, py_1, 3, 6);
 408 CLOSEYUV2RGBFUNC(8)
 409
 410 // r, g, b, dst_1, dst_2
 411 YUV2RGBFUNC(yuv2rgb_c_8_ordered_dither, uint8_t, 0)
 412     const uint8_t *d32 = dither_8x8_32[y & 7];
 413     const uint8_t *d64 = dither_8x8_73[y & 7];
 414
 415 #define PUTRGB8(dst, src, i, o)                     \
 416     Y              = src[2 * i];                    \
 417     dst[2 * i]     = r[Y + d32[0 + o]] +            \
 418                      g[Y + d32[0 + o]] +            \
 419                      b[Y + d64[0 + o]];             \
 420     Y              = src[2 * i + 1];                \
 421     dst[2 * i + 1] = r[Y + d32[1 + o]] +            \
 422                      g[Y + d32[1 + o]] +            \
 423                      b[Y + d64[1 + o]];
 424
 425     LOADCHROMA(0);
 426     PUTRGB8(dst_1, py_1, 0, 0);
 427     PUTRGB8(dst_2, py_2, 0, 0 + 8);
 428
 429     LOADCHROMA(1);
 430     PUTRGB8(dst_2, py_2, 1, 2 + 8);
 431     PUTRGB8(dst_1, py_1, 1, 2);
 432
 433     LOADCHROMA(2);
 434     PUTRGB8(dst_1, py_1, 2, 4);
 435     PUTRGB8(dst_2, py_2, 2, 4 + 8);
 436
 437     LOADCHROMA(3);
 438     PUTRGB8(dst_2, py_2, 3, 6 + 8);
 439     PUTRGB8(dst_1, py_1, 3, 6);
 440 CLOSEYUV2RGBFUNC(8)
 441
 442 YUV2RGBFUNC(yuv2rgb_c_4_ordered_dither, uint8_t, 0)
 443     const uint8_t * d64 = dither_8x8_73[y & 7];
 444     const uint8_t *d128 = dither_8x8_220[y & 7];
 445     int acc;
 446
 447 #define PUTRGB4D(dst, src, i, o)                    \
 448     Y      = src[2 * i];                            \
 449     acc    = r[Y + d128[0 + o]] +                   \
 450              g[Y +  d64[0 + o]] +                   \
 451              b[Y + d128[0 + o]];                    \
 452     Y      = src[2 * i + 1];                        \
 453     acc   |= (r[Y + d128[1 + o]] +                  \
 454               g[Y +  d64[1 + o]] +                  \
 455               b[Y + d128[1 + o]]) << 4;             \
 456     dst[i] = acc;
 457
 458     LOADCHROMA(0);
 459     PUTRGB4D(dst_1, py_1, 0, 0);
 460     PUTRGB4D(dst_2, py_2, 0, 0 + 8);
 461
 462     LOADCHROMA(1);
 463     PUTRGB4D(dst_2, py_2, 1, 2 + 8);
 464     PUTRGB4D(dst_1, py_1, 1, 2);
 465
 466     LOADCHROMA(2);
 467     PUTRGB4D(dst_1, py_1, 2, 4);
 468     PUTRGB4D(dst_2, py_2, 2, 4 + 8);
 469
 470     LOADCHROMA(3);
 471     PUTRGB4D(dst_2, py_2, 3, 6 + 8);
 472     PUTRGB4D(dst_1, py_1, 3, 6);
 473 CLOSEYUV2RGBFUNC(4)
 474
 475 YUV2RGBFUNC(yuv2rgb_c_4b_ordered_dither, uint8_t, 0)
 476     const uint8_t *d64  = dither_8x8_73[y & 7];
 477     const uint8_t *d128 = dither_8x8_220[y & 7];
 478
 479 #define PUTRGB4DB(dst, src, i, o)                   \
 480     Y              = src[2 * i];                    \
 481     dst[2 * i]     = r[Y + d128[0 + o]] +           \
 482                      g[Y +  d64[0 + o]] +           \
 483                      b[Y + d128[0 + o]];            \
 484     Y              = src[2 * i + 1];                \
 485     dst[2 * i + 1] = r[Y + d128[1 + o]] +           \
 486                      g[Y +  d64[1 + o]] +           \
 487                      b[Y + d128[1 + o]];
 488
 489     LOADCHROMA(0);
 490     PUTRGB4DB(dst_1, py_1, 0, 0);
 491     PUTRGB4DB(dst_2, py_2, 0, 0 + 8);
 492
 493     LOADCHROMA(1);
 494     PUTRGB4DB(dst_2, py_2, 1, 2 + 8);
 495     PUTRGB4DB(dst_1, py_1, 1, 2);
 496
 497     LOADCHROMA(2);
 498     PUTRGB4DB(dst_1, py_1, 2, 4);
 499     PUTRGB4DB(dst_2, py_2, 2, 4 + 8);
 500
 501     LOADCHROMA(3);
 502     PUTRGB4DB(dst_2, py_2, 3, 6 + 8);
 503     PUTRGB4DB(dst_1, py_1, 3, 6);
 504 CLOSEYUV2RGBFUNC(8)
 505
 506 YUV2RGBFUNC(yuv2rgb_c_1_ordered_dither, uint8_t, 0)
 507     const uint8_t *d128 = dither_8x8_220[y & 7];
 508     char out_1 = 0, out_2 = 0;
 509     g = c->table_gU[128 + YUVRGB_TABLE_HEADROOM] + c->table_gV[128 + YUVRGB_TABLE_HEADROOM];
 510
 511 #define PUTRGB1(out, src, i, o)                     \
 512     Y    = src[2 * i];                              \
 513     out += out + g[Y + d128[0 + o]];                \
 514     Y    = src[2 * i + 1];                          \
 515     out += out + g[Y + d128[1 + o]];
 516
 517     PUTRGB1(out_1, py_1, 0, 0);
 518     PUTRGB1(out_2, py_2, 0, 0 + 8);
 519
 520     PUTRGB1(out_2, py_2, 1, 2 + 8);
 521     PUTRGB1(out_1, py_1, 1, 2);
 522
 523     PUTRGB1(out_1, py_1, 2, 4);
 524     PUTRGB1(out_2, py_2, 2, 4 + 8);
 525
 526     PUTRGB1(out_2, py_2, 3, 6 + 8);
 527     PUTRGB1(out_1, py_1, 3, 6);
 528
 529     dst_1[0] = out_1;
 530     dst_2[0] = out_2;
 531 CLOSEYUV2RGBFUNC(1)
 532
 533 SwsFunc ff_yuv2rgb_get_func_ptr(SwsContext *c)
 534 {
 535     SwsFunc t = NULL;
 536
 537     if (HAVE_MMX)
 538         t = ff_yuv2rgb_init_mmx(c);
 539     else if (HAVE_VIS)
 540         t = ff_yuv2rgb_init_vis(c);
 541     else if (HAVE_ALTIVEC)
 542         t = ff_yuv2rgb_init_altivec(c);
 543     else if (ARCH_BFIN)
 544         t = ff_yuv2rgb_get_func_ptr_bfin(c);
 545
 546     if (t)
 547         return t;
 548
 549     av_log(c, AV_LOG_WARNING,
 550            "No accelerated colorspace conversion found from %s to %s.\n",
 551            av_get_pix_fmt_name(c->srcFormat), av_get_pix_fmt_name(c->dstFormat));
 552
 553     switch (c->dstFormat) {
 554     case PIX_FMT_BGR48BE:
 555     case PIX_FMT_BGR48LE:
 556         return yuv2rgb_c_bgr48;
 557     case PIX_FMT_RGB48BE:
 558     case PIX_FMT_RGB48LE:
 559         return yuv2rgb_c_48;
 560     case PIX_FMT_ARGB:
 561     case PIX_FMT_ABGR:
 562         if (CONFIG_SWSCALE_ALPHA && isALPHA(c->srcFormat))
 563             return yuva2argb_c;
 564     case PIX_FMT_RGBA:
 565     case PIX_FMT_BGRA:
 566         return (CONFIG_SWSCALE_ALPHA && isALPHA(c->srcFormat)) ? yuva2rgba_c : yuv2rgb_c_32;
 567     case PIX_FMT_RGB24:
 568         return yuv2rgb_c_24_rgb;
 569     case PIX_FMT_BGR24:
 570         return yuv2rgb_c_24_bgr;
 571     case PIX_FMT_RGB565:
 572     case PIX_FMT_BGR565:
 573     case PIX_FMT_RGB555:
 574     case PIX_FMT_BGR555:
 575         return yuv2rgb_c_16;
 576     case PIX_FMT_RGB444:
 577     case PIX_FMT_BGR444:
 578         return yuv2rgb_c_12_ordered_dither;
 579     case PIX_FMT_RGB8:
 580     case PIX_FMT_BGR8:
 581         return yuv2rgb_c_8_ordered_dither;
 582     case PIX_FMT_RGB4:
 583     case PIX_FMT_BGR4:
 584         return yuv2rgb_c_4_ordered_dither;
 585     case PIX_FMT_RGB4_BYTE:
 586     case PIX_FMT_BGR4_BYTE:
 587         return yuv2rgb_c_4b_ordered_dither;
 588     case PIX_FMT_MONOBLACK:
 589         return yuv2rgb_c_1_ordered_dither;
 590     default:
 591         assert(0);
 592     }
 593     return NULL;
 594 }
 595
 596 static void fill_table(uint8_t* table[256 + 2*YUVRGB_TABLE_HEADROOM], const int elemsize,
 597                        const int inc, void *y_tab)
 598 {
 599     int i;
 600     uint8_t *y_table = y_tab;
 601
 602     y_table -= elemsize * (inc >> 9);
 603
 604     for (i = 0; i < 256 + 2*YUVRGB_TABLE_HEADROOM; i++) {
 605         int64_t cb = av_clip(i-YUVRGB_TABLE_HEADROOM, 0, 255)*inc;
 606         table[i] = y_table + elemsize * (cb >> 16);
 607     }
 608 }
 609
 610 static void fill_gv_table(int table[256 + 2*YUVRGB_TABLE_HEADROOM], const int elemsize, const int inc)
 611 {
 612     int i;
 613     int off    = -(inc >> 9);
 614
 615     for (i = 0; i < 256 + 2*YUVRGB_TABLE_HEADROOM; i++) {
 616         int64_t cb = av_clip(i-YUVRGB_TABLE_HEADROOM, 0, 255)*inc;
 617         table[i] = elemsize * (off + (cb >> 16));
 618     }
 619 }
 620
 621 static uint16_t roundToInt16(int64_t f)
 622 {
 623     int r = (f + (1 << 15)) >> 16;
 624
 625     if (r < -0x7FFF)
 626         return 0x8000;
 627     else if (r > 0x7FFF)
 628         return 0x7FFF;
 629     else
 630         return r;
 631 }
 632
 633 av_cold int ff_yuv2rgb_c_init_tables(SwsContext *c, const int inv_table[4],
 634                                      int fullRange, int brightness,
 635                                      int contrast, int saturation)
 636 {
 637     const int isRgb = c->dstFormat == PIX_FMT_RGB32     ||
 638                       c->dstFormat == PIX_FMT_RGB32_1   ||
 639                       c->dstFormat == PIX_FMT_BGR24     ||
 640                       c->dstFormat == PIX_FMT_RGB565BE  ||
 641                       c->dstFormat == PIX_FMT_RGB565LE  ||
 642                       c->dstFormat == PIX_FMT_RGB555BE  ||
 643                       c->dstFormat == PIX_FMT_RGB555LE  ||
 644                       c->dstFormat == PIX_FMT_RGB444BE  ||
 645                       c->dstFormat == PIX_FMT_RGB444LE  ||
 646                       c->dstFormat == PIX_FMT_RGB8      ||
 647                       c->dstFormat == PIX_FMT_RGB4      ||
 648                       c->dstFormat == PIX_FMT_RGB4_BYTE ||
 649                       c->dstFormat == PIX_FMT_MONOBLACK;
 650     const int isNotNe = c->dstFormat == PIX_FMT_NE(RGB565LE, RGB565BE) ||
 651                         c->dstFormat == PIX_FMT_NE(RGB555LE, RGB555BE) ||
 652                         c->dstFormat == PIX_FMT_NE(RGB444LE, RGB444BE) ||
 653                         c->dstFormat == PIX_FMT_NE(BGR565LE, BGR565BE) ||
 654                         c->dstFormat == PIX_FMT_NE(BGR555LE, BGR555BE) ||
 655                         c->dstFormat == PIX_FMT_NE(BGR444LE, BGR444BE);
 656     const int bpp = c->dstFormatBpp;
 657     uint8_t *y_table;
 658     uint16_t *y_table16;
 659     uint32_t *y_table32;
 660     int i, base, rbase, gbase, bbase, av_uninit(abase), needAlpha;
 661     const int yoffs = fullRange ? 384 : 326;
 662
 663     int64_t crv =  inv_table[0];
 664     int64_t cbu =  inv_table[1];
 665     int64_t cgu = -inv_table[2];
 666     int64_t cgv = -inv_table[3];
 667     int64_t cy  = 1 << 16;
 668     int64_t oy  = 0;
 669     int64_t yb  = 0;
 670
 671     if (!fullRange) {
 672         cy = (cy * 255) / 219;
 673         oy = 16 << 16;
 674     } else {
 675         crv = (crv * 224) / 255;
 676         cbu = (cbu * 224) / 255;
 677         cgu = (cgu * 224) / 255;
 678         cgv = (cgv * 224) / 255;
 679     }
 680
 681     cy   = (cy  * contrast)              >> 16;
 682     crv  = (crv * contrast * saturation) >> 32;
 683     cbu  = (cbu * contrast * saturation) >> 32;
 684     cgu  = (cgu * contrast * saturation) >> 32;
 685     cgv  = (cgv * contrast * saturation) >> 32;
 686     oy  -= 256 * brightness;
 687
 688     c->uOffset = 0x0400040004000400LL;
 689     c->vOffset = 0x0400040004000400LL;
 690     c->yCoeff  = roundToInt16(cy  * 8192) * 0x0001000100010001ULL;
 691     c->vrCoeff = roundToInt16(crv * 8192) * 0x0001000100010001ULL;
 692     c->ubCoeff = roundToInt16(cbu * 8192) * 0x0001000100010001ULL;
 693     c->vgCoeff = roundToInt16(cgv * 8192) * 0x0001000100010001ULL;
 694     c->ugCoeff = roundToInt16(cgu * 8192) * 0x0001000100010001ULL;
 695     c->yOffset = roundToInt16(oy  *    8) * 0x0001000100010001ULL;
 696
 697     c->yuv2rgb_y_coeff   = (int16_t)roundToInt16(cy  << 13);
 698     c->yuv2rgb_y_offset  = (int16_t)roundToInt16(oy  <<  9);
 699     c->yuv2rgb_v2r_coeff = (int16_t)roundToInt16(crv << 13);
 700     c->yuv2rgb_v2g_coeff = (int16_t)roundToInt16(cgv << 13);
 701     c->yuv2rgb_u2g_coeff = (int16_t)roundToInt16(cgu << 13);
 702     c->yuv2rgb_u2b_coeff = (int16_t)roundToInt16(cbu << 13);
 703
 704     //scale coefficients by cy
 705     crv = ((crv << 16) + 0x8000) / cy;
 706     cbu = ((cbu << 16) + 0x8000) / cy;
 707     cgu = ((cgu << 16) + 0x8000) / cy;
 708     cgv = ((cgv << 16) + 0x8000) / cy;
 709
 710     av_free(c->yuvTable);
 711
 712     switch (bpp) {
 713     case 1:
 714         c->yuvTable = av_malloc(1024);
 715         y_table     = c->yuvTable;
 716         yb = -(384 << 16) - oy;
 717         for (i = 0; i < 1024 - 110; i++) {
 718             y_table[i + 110]  = av_clip_uint8((yb + 0x8000) >> 16) >> 7;
 719             yb               += cy;
 720         }
 721         fill_table(c->table_gU, 1, cgu, y_table + yoffs);
 722         fill_gv_table(c->table_gV, 1, cgv);
 723         break;
 724     case 4:
 725     case 4 | 128:
 726         rbase       = isRgb ? 3 : 0;
 727         gbase       = 1;
 728         bbase       = isRgb ? 0 : 3;
 729         c->yuvTable = av_malloc(1024 * 3);
 730         y_table     = c->yuvTable;
 731         yb = -(384 << 16) - oy;
 732         for (i = 0; i < 1024 - 110; i++) {
 733             int yval                = av_clip_uint8((yb + 0x8000) >> 16);
 734             y_table[i + 110]        = (yval >> 7)        << rbase;
 735             y_table[i +  37 + 1024] = ((yval + 43) / 85) << gbase;
 736             y_table[i + 110 + 2048] = (yval >> 7)        << bbase;
 737             yb += cy;
 738         }
 739         fill_table(c->table_rV, 1, crv, y_table + yoffs);
 740         fill_table(c->table_gU, 1, cgu, y_table + yoffs + 1024);
 741         fill_table(c->table_bU, 1, cbu, y_table + yoffs + 2048);
 742         fill_gv_table(c->table_gV, 1, cgv);
 743         break;
 744     case 8:
 745         rbase       = isRgb ? 5 : 0;
 746         gbase       = isRgb ? 2 : 3;
 747         bbase       = isRgb ? 0 : 6;
 748         c->yuvTable = av_malloc(1024 * 3);
 749         y_table     = c->yuvTable;
 750         yb = -(384 << 16) - oy;
 751         for (i = 0; i < 1024 - 38; i++) {
 752             int yval               = av_clip_uint8((yb + 0x8000) >> 16);
 753             y_table[i + 16]        = ((yval + 18) / 36) << rbase;
 754             y_table[i + 16 + 1024] = ((yval + 18) / 36) << gbase;
 755             y_table[i + 37 + 2048] = ((yval + 43) / 85) << bbase;
 756             yb += cy;
 757         }
 758         fill_table(c->table_rV, 1, crv, y_table + yoffs);
 759         fill_table(c->table_gU, 1, cgu, y_table + yoffs + 1024);
 760         fill_table(c->table_bU, 1, cbu, y_table + yoffs + 2048);
 761         fill_gv_table(c->table_gV, 1, cgv);
 762         break;
 763     case 12:
 764         rbase       = isRgb ? 8 : 0;
 765         gbase       = 4;
 766         bbase       = isRgb ? 0 : 8;
 767         c->yuvTable = av_malloc(1024 * 3 * 2);
 768         y_table16   = c->yuvTable;
 769         yb = -(384 << 16) - oy;
 770         for (i = 0; i < 1024; i++) {
 771             uint8_t yval        = av_clip_uint8((yb + 0x8000) >> 16);
 772             y_table16[i]        = (yval >> 4) << rbase;
 773             y_table16[i + 1024] = (yval >> 4) << gbase;
 774             y_table16[i + 2048] = (yval >> 4) << bbase;
 775             yb += cy;
 776         }
 777         if (isNotNe)
 778             for (i = 0; i < 1024 * 3; i++)
 779                 y_table16[i] = av_bswap16(y_table16[i]);
 780         fill_table(c->table_rV, 2, crv, y_table16 + yoffs);
 781         fill_table(c->table_gU, 2, cgu, y_table16 + yoffs + 1024);
 782         fill_table(c->table_bU, 2, cbu, y_table16 + yoffs + 2048);
 783         fill_gv_table(c->table_gV, 2, cgv);
 784         break;
 785     case 15:
 786     case 16:
 787         rbase       = isRgb ? bpp - 5 : 0;
 788         gbase       = 5;
 789         bbase       = isRgb ? 0 : (bpp - 5);
 790         c->yuvTable = av_malloc(1024 * 3 * 2);
 791         y_table16   = c->yuvTable;
 792         yb = -(384 << 16) - oy;
 793         for (i = 0; i < 1024; i++) {
 794             uint8_t yval        = av_clip_uint8((yb + 0x8000) >> 16);
 795             y_table16[i]        = (yval >> 3)          << rbase;
 796             y_table16[i + 1024] = (yval >> (18 - bpp)) << gbase;
 797             y_table16[i + 2048] = (yval >> 3)          << bbase;
 798             yb += cy;
 799         }
 800         if (isNotNe)
 801             for (i = 0; i < 1024 * 3; i++)
 802                 y_table16[i] = av_bswap16(y_table16[i]);
 803         fill_table(c->table_rV, 2, crv, y_table16 + yoffs);
 804         fill_table(c->table_gU, 2, cgu, y_table16 + yoffs + 1024);
 805         fill_table(c->table_bU, 2, cbu, y_table16 + yoffs + 2048);
 806         fill_gv_table(c->table_gV, 2, cgv);
 807         break;
 808     case 24:
 809     case 48:
 810         c->yuvTable = av_malloc(1024);
 811         y_table     = c->yuvTable;
 812         yb = -(384 << 16) - oy;
 813         for (i = 0; i < 1024; i++) {
 814             y_table[i]  = av_clip_uint8((yb + 0x8000) >> 16);
 815             yb         += cy;
 816         }
 817         fill_table(c->table_rV, 1, crv, y_table + yoffs);
 818         fill_table(c->table_gU, 1, cgu, y_table + yoffs);
 819         fill_table(c->table_bU, 1, cbu, y_table + yoffs);
 820         fill_gv_table(c->table_gV, 1, cgv);
 821         break;
 822     case 32:
 823         base      = (c->dstFormat == PIX_FMT_RGB32_1 ||
 824                      c->dstFormat == PIX_FMT_BGR32_1) ? 8 : 0;
 825         rbase     = base + (isRgb ? 16 : 0);
 826         gbase     = base + 8;
 827         bbase     = base + (isRgb ? 0 : 16);
 828         needAlpha = CONFIG_SWSCALE_ALPHA && isALPHA(c->srcFormat);
 829         if (!needAlpha)
 830             abase = (base + 24) & 31;
 831         c->yuvTable = av_malloc(1024 * 3 * 4);
 832         y_table32   = c->yuvTable;
 833         yb = -(384 << 16) - oy;
 834         for (i = 0; i < 1024; i++) {
 835             unsigned yval       = av_clip_uint8((yb + 0x8000) >> 16);
 836             y_table32[i]        = (yval << rbase) +
 837                                   (needAlpha ? 0 : (255u << abase));
 838             y_table32[i + 1024] =  yval << gbase;
 839             y_table32[i + 2048] =  yval << bbase;
 840             yb += cy;
 841         }
 842         fill_table(c->table_rV, 4, crv, y_table32 + yoffs);
 843         fill_table(c->table_gU, 4, cgu, y_table32 + yoffs + 1024);
 844         fill_table(c->table_bU, 4, cbu, y_table32 + yoffs + 2048);
 845         fill_gv_table(c->table_gV, 4, cgv);
 846         break;
 847     default:
 848         c->yuvTable = NULL;
 849         av_log(c, AV_LOG_ERROR, "%ibpp not supported by yuv2rgb\n", bpp);
 850         return -1;
 851     }
 852     return 0;
 853 }