446b433b3f67c311fdcd2c78d74e488abd0efb1a
[ffmpeg.git] / 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 }