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