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