avfilter/drawutils: P010 is not supported
[ffmpeg.git] / libavfilter / drawutils.c
1 /*
2  * Copyright 2011 Stefano Sabatini <stefano.sabatini-lala poste it>
3  * Copyright 2012 Nicolas George <nicolas.george normalesup org>
4  *
5  * This file is part of FFmpeg.
6  *
7  * FFmpeg is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU Lesser General Public
9  * License as published by the Free Software Foundation; either
10  * version 2.1 of the License, or (at your option) any later version.
11  *
12  * FFmpeg is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15  * Lesser General Public License for more details.
16  *
17  * You should have received a copy of the GNU Lesser General Public
18  * License along with FFmpeg; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20  */
21
22 #include <string.h>
23
24 #include "libavutil/avassert.h"
25 #include "libavutil/avutil.h"
26 #include "libavutil/colorspace.h"
27 #include "libavutil/intreadwrite.h"
28 #include "libavutil/mem.h"
29 #include "libavutil/pixdesc.h"
30 #include "drawutils.h"
31 #include "formats.h"
32
33 enum { RED = 0, GREEN, BLUE, ALPHA };
34
35 int ff_fill_rgba_map(uint8_t *rgba_map, enum AVPixelFormat pix_fmt)
36 {
37     switch (pix_fmt) {
38     case AV_PIX_FMT_0RGB:
39     case AV_PIX_FMT_ARGB:  rgba_map[ALPHA] = 0; rgba_map[RED  ] = 1; rgba_map[GREEN] = 2; rgba_map[BLUE ] = 3; break;
40     case AV_PIX_FMT_0BGR:
41     case AV_PIX_FMT_ABGR:  rgba_map[ALPHA] = 0; rgba_map[BLUE ] = 1; rgba_map[GREEN] = 2; rgba_map[RED  ] = 3; break;
42     case AV_PIX_FMT_RGB48LE:
43     case AV_PIX_FMT_RGB48BE:
44     case AV_PIX_FMT_RGBA64BE:
45     case AV_PIX_FMT_RGBA64LE:
46     case AV_PIX_FMT_RGB0:
47     case AV_PIX_FMT_RGBA:
48     case AV_PIX_FMT_RGB24: rgba_map[RED  ] = 0; rgba_map[GREEN] = 1; rgba_map[BLUE ] = 2; rgba_map[ALPHA] = 3; break;
49     case AV_PIX_FMT_BGR48LE:
50     case AV_PIX_FMT_BGR48BE:
51     case AV_PIX_FMT_BGRA64BE:
52     case AV_PIX_FMT_BGRA64LE:
53     case AV_PIX_FMT_BGRA:
54     case AV_PIX_FMT_BGR0:
55     case AV_PIX_FMT_BGR24: rgba_map[BLUE ] = 0; rgba_map[GREEN] = 1; rgba_map[RED  ] = 2; rgba_map[ALPHA] = 3; break;
56     case AV_PIX_FMT_GBRP9LE:
57     case AV_PIX_FMT_GBRP9BE:
58     case AV_PIX_FMT_GBRP10LE:
59     case AV_PIX_FMT_GBRP10BE:
60     case AV_PIX_FMT_GBRP12LE:
61     case AV_PIX_FMT_GBRP12BE:
62     case AV_PIX_FMT_GBRP14LE:
63     case AV_PIX_FMT_GBRP14BE:
64     case AV_PIX_FMT_GBRP16LE:
65     case AV_PIX_FMT_GBRP16BE:
66     case AV_PIX_FMT_GBRAP:
67     case AV_PIX_FMT_GBRAP12LE:
68     case AV_PIX_FMT_GBRAP12BE:
69     case AV_PIX_FMT_GBRAP16LE:
70     case AV_PIX_FMT_GBRAP16BE:
71     case AV_PIX_FMT_GBRP:  rgba_map[GREEN] = 0; rgba_map[BLUE ] = 1; rgba_map[RED  ] = 2; rgba_map[ALPHA] = 3; break;
72     default:                    /* unsupported */
73         return AVERROR(EINVAL);
74     }
75     return 0;
76 }
77
78 int ff_fill_line_with_color(uint8_t *line[4], int pixel_step[4], int w, uint8_t dst_color[4],
79                             enum AVPixelFormat pix_fmt, uint8_t rgba_color[4],
80                             int *is_packed_rgba, uint8_t rgba_map_ptr[4])
81 {
82     uint8_t rgba_map[4] = {0};
83     int i;
84     const AVPixFmtDescriptor *pix_desc = av_pix_fmt_desc_get(pix_fmt);
85     int hsub;
86
87     av_assert0(pix_desc);
88
89     hsub = pix_desc->log2_chroma_w;
90
91     *is_packed_rgba = ff_fill_rgba_map(rgba_map, pix_fmt) >= 0;
92
93     if (*is_packed_rgba) {
94         pixel_step[0] = (av_get_bits_per_pixel(pix_desc))>>3;
95         for (i = 0; i < 4; i++)
96             dst_color[rgba_map[i]] = rgba_color[i];
97
98         line[0] = av_malloc_array(w, pixel_step[0]);
99         if (!line[0])
100             return AVERROR(ENOMEM);
101         for (i = 0; i < w; i++)
102             memcpy(line[0] + i * pixel_step[0], dst_color, pixel_step[0]);
103         if (rgba_map_ptr)
104             memcpy(rgba_map_ptr, rgba_map, sizeof(rgba_map[0]) * 4);
105     } else {
106         int plane;
107
108         dst_color[0] = RGB_TO_Y_CCIR(rgba_color[0], rgba_color[1], rgba_color[2]);
109         dst_color[1] = RGB_TO_U_CCIR(rgba_color[0], rgba_color[1], rgba_color[2], 0);
110         dst_color[2] = RGB_TO_V_CCIR(rgba_color[0], rgba_color[1], rgba_color[2], 0);
111         dst_color[3] = rgba_color[3];
112
113         for (plane = 0; plane < 4; plane++) {
114             int line_size;
115             int hsub1 = (plane == 1 || plane == 2) ? hsub : 0;
116
117             pixel_step[plane] = 1;
118             line_size = AV_CEIL_RSHIFT(w, hsub1) * pixel_step[plane];
119             line[plane] = av_malloc(line_size);
120             if (!line[plane]) {
121                 while(plane && line[plane-1])
122                     av_freep(&line[--plane]);
123                 return AVERROR(ENOMEM);
124             }
125             memset(line[plane], dst_color[plane], line_size);
126         }
127     }
128
129     return 0;
130 }
131
132 void ff_draw_rectangle(uint8_t *dst[4], int dst_linesize[4],
133                        uint8_t *src[4], int pixelstep[4],
134                        int hsub, int vsub, int x, int y, int w, int h)
135 {
136     int i, plane;
137     uint8_t *p;
138
139     for (plane = 0; plane < 4 && dst[plane]; plane++) {
140         int hsub1 = plane == 1 || plane == 2 ? hsub : 0;
141         int vsub1 = plane == 1 || plane == 2 ? vsub : 0;
142         int width  = AV_CEIL_RSHIFT(w, hsub1);
143         int height = AV_CEIL_RSHIFT(h, vsub1);
144
145         p = dst[plane] + (y >> vsub1) * dst_linesize[plane];
146         for (i = 0; i < height; i++) {
147             memcpy(p + (x >> hsub1) * pixelstep[plane],
148                    src[plane], width * pixelstep[plane]);
149             p += dst_linesize[plane];
150         }
151     }
152 }
153
154 void ff_copy_rectangle(uint8_t *dst[4], int dst_linesize[4],
155                        uint8_t *src[4], int src_linesize[4], int pixelstep[4],
156                        int hsub, int vsub, int x, int y, int y2, int w, int h)
157 {
158     int i, plane;
159     uint8_t *p;
160
161     for (plane = 0; plane < 4 && dst[plane]; plane++) {
162         int hsub1 = plane == 1 || plane == 2 ? hsub : 0;
163         int vsub1 = plane == 1 || plane == 2 ? vsub : 0;
164         int width  = AV_CEIL_RSHIFT(w, hsub1);
165         int height = AV_CEIL_RSHIFT(h, vsub1);
166
167         p = dst[plane] + (y >> vsub1) * dst_linesize[plane];
168         for (i = 0; i < height; i++) {
169             memcpy(p + (x >> hsub1) * pixelstep[plane],
170                    src[plane] + src_linesize[plane]*(i+(y2>>vsub1)), width * pixelstep[plane]);
171             p += dst_linesize[plane];
172         }
173     }
174 }
175
176 int ff_draw_init(FFDrawContext *draw, enum AVPixelFormat format, unsigned flags)
177 {
178     const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(format);
179     const AVComponentDescriptor *c;
180     unsigned i, nb_planes = 0;
181     int pixelstep[MAX_PLANES] = { 0 };
182
183     if (!desc || !desc->name)
184         return AVERROR(EINVAL);
185     if (desc->flags & ~(AV_PIX_FMT_FLAG_PLANAR | AV_PIX_FMT_FLAG_RGB | AV_PIX_FMT_FLAG_PSEUDOPAL | AV_PIX_FMT_FLAG_ALPHA))
186         return AVERROR(ENOSYS);
187     if (format == AV_PIX_FMT_P010LE || format == AV_PIX_FMT_P010BE)
188         return AVERROR(ENOSYS);
189     for (i = 0; i < desc->nb_components; i++) {
190         c = &desc->comp[i];
191         /* for now, only 8-16 bits formats */
192         if (c->depth < 8 || c->depth > 16)
193             return AVERROR(ENOSYS);
194         if (desc->flags & AV_PIX_FMT_FLAG_BE)
195             return AVERROR(ENOSYS);
196         if (c->plane >= MAX_PLANES)
197             return AVERROR(ENOSYS);
198         /* strange interleaving */
199         if (pixelstep[c->plane] != 0 &&
200             pixelstep[c->plane] != c->step)
201             return AVERROR(ENOSYS);
202         if (pixelstep[c->plane] == 6 &&
203             c->depth == 16)
204             return AVERROR(ENOSYS);
205         pixelstep[c->plane] = c->step;
206         if (pixelstep[c->plane] >= 8)
207             return AVERROR(ENOSYS);
208         nb_planes = FFMAX(nb_planes, c->plane + 1);
209     }
210     memset(draw, 0, sizeof(*draw));
211     draw->desc      = desc;
212     draw->format    = format;
213     draw->nb_planes = nb_planes;
214     memcpy(draw->pixelstep, pixelstep, sizeof(draw->pixelstep));
215     draw->hsub[1] = draw->hsub[2] = draw->hsub_max = desc->log2_chroma_w;
216     draw->vsub[1] = draw->vsub[2] = draw->vsub_max = desc->log2_chroma_h;
217     for (i = 0; i < (desc->nb_components - !!(desc->flags & AV_PIX_FMT_FLAG_ALPHA)); i++)
218         draw->comp_mask[desc->comp[i].plane] |=
219             1 << desc->comp[i].offset;
220     return 0;
221 }
222
223 void ff_draw_color(FFDrawContext *draw, FFDrawColor *color, const uint8_t rgba[4])
224 {
225     unsigned i;
226     uint8_t rgba_map[4];
227
228     if (rgba != color->rgba)
229         memcpy(color->rgba, rgba, sizeof(color->rgba));
230     if ((draw->desc->flags & AV_PIX_FMT_FLAG_RGB) &&
231         ff_fill_rgba_map(rgba_map, draw->format) >= 0) {
232         if (draw->nb_planes == 1) {
233             for (i = 0; i < 4; i++) {
234                 color->comp[0].u8[rgba_map[i]] = rgba[i];
235                 if (draw->desc->comp[rgba_map[i]].depth > 8) {
236                     color->comp[0].u16[rgba_map[i]] = color->comp[0].u8[rgba_map[i]] << 8;
237                 }
238             }
239         } else {
240             for (i = 0; i < 4; i++) {
241                 color->comp[rgba_map[i]].u8[0] = rgba[i];
242                 if (draw->desc->comp[rgba_map[i]].depth > 8)
243                     color->comp[rgba_map[i]].u16[0] = color->comp[rgba_map[i]].u8[0] << (draw->desc->comp[rgba_map[i]].depth - 8);
244             }
245         }
246     } else if (draw->nb_planes >= 2) {
247         /* assume YUV */
248         const AVPixFmtDescriptor *desc = draw->desc;
249         color->comp[desc->comp[0].plane].u8[desc->comp[0].offset] = RGB_TO_Y_CCIR(rgba[0], rgba[1], rgba[2]);
250         color->comp[desc->comp[1].plane].u8[desc->comp[1].offset] = RGB_TO_U_CCIR(rgba[0], rgba[1], rgba[2], 0);
251         color->comp[desc->comp[2].plane].u8[desc->comp[2].offset] = RGB_TO_V_CCIR(rgba[0], rgba[1], rgba[2], 0);
252         color->comp[3].u8[0] = rgba[3];
253 #define EXPAND(compn) \
254         if (desc->comp[compn].depth > 8) \
255             color->comp[desc->comp[compn].plane].u16[desc->comp[compn].offset] = \
256             color->comp[desc->comp[compn].plane].u8[desc->comp[compn].offset] << (draw->desc->comp[compn].depth - 8)
257         EXPAND(3);
258         EXPAND(2);
259         EXPAND(1);
260         EXPAND(0);
261     } else if (draw->format == AV_PIX_FMT_GRAY8 || draw->format == AV_PIX_FMT_GRAY8A) {
262         color->comp[0].u8[0] = RGB_TO_Y_CCIR(rgba[0], rgba[1], rgba[2]);
263         color->comp[1].u8[0] = rgba[3];
264     } else if (draw->format == AV_PIX_FMT_GRAY16LE || draw->format == AV_PIX_FMT_YA16LE) {
265         color->comp[0].u8[0] = RGB_TO_Y_CCIR(rgba[0], rgba[1], rgba[2]);
266         color->comp[0].u16[0] = color->comp[0].u8[0] << 8;
267         color->comp[1].u8[0] = rgba[3];
268         color->comp[1].u16[0] = color->comp[1].u8[0] << 8;
269     } else {
270         av_log(NULL, AV_LOG_WARNING,
271                "Color conversion not implemented for %s\n", draw->desc->name);
272         memset(color, 128, sizeof(*color));
273     }
274 }
275
276 static uint8_t *pointer_at(FFDrawContext *draw, uint8_t *data[], int linesize[],
277                            int plane, int x, int y)
278 {
279     return data[plane] +
280            (y >> draw->vsub[plane]) * linesize[plane] +
281            (x >> draw->hsub[plane]) * draw->pixelstep[plane];
282 }
283
284 void ff_copy_rectangle2(FFDrawContext *draw,
285                         uint8_t *dst[], int dst_linesize[],
286                         uint8_t *src[], int src_linesize[],
287                         int dst_x, int dst_y, int src_x, int src_y,
288                         int w, int h)
289 {
290     int plane, y, wp, hp;
291     uint8_t *p, *q;
292
293     for (plane = 0; plane < draw->nb_planes; plane++) {
294         p = pointer_at(draw, src, src_linesize, plane, src_x, src_y);
295         q = pointer_at(draw, dst, dst_linesize, plane, dst_x, dst_y);
296         wp = AV_CEIL_RSHIFT(w, draw->hsub[plane]) * draw->pixelstep[plane];
297         hp = AV_CEIL_RSHIFT(h, draw->vsub[plane]);
298         for (y = 0; y < hp; y++) {
299             memcpy(q, p, wp);
300             p += src_linesize[plane];
301             q += dst_linesize[plane];
302         }
303     }
304 }
305
306 void ff_fill_rectangle(FFDrawContext *draw, FFDrawColor *color,
307                        uint8_t *dst[], int dst_linesize[],
308                        int dst_x, int dst_y, int w, int h)
309 {
310     int plane, x, y, wp, hp;
311     uint8_t *p0, *p;
312     FFDrawColor color_tmp = *color;
313
314     for (plane = 0; plane < draw->nb_planes; plane++) {
315         p0 = pointer_at(draw, dst, dst_linesize, plane, dst_x, dst_y);
316         wp = AV_CEIL_RSHIFT(w, draw->hsub[plane]);
317         hp = AV_CEIL_RSHIFT(h, draw->vsub[plane]);
318         if (!hp)
319             return;
320         p = p0;
321
322         if (HAVE_BIGENDIAN && draw->desc->comp[0].depth > 8) {
323             for (x = 0; 2*x < draw->pixelstep[plane]; x++)
324                 color_tmp.comp[plane].u16[x] = av_bswap16(color_tmp.comp[plane].u16[x]);
325         }
326
327         /* copy first line from color */
328         for (x = 0; x < wp; x++) {
329             memcpy(p, color_tmp.comp[plane].u8, draw->pixelstep[plane]);
330             p += draw->pixelstep[plane];
331         }
332         wp *= draw->pixelstep[plane];
333         /* copy next lines from first line */
334         p = p0 + dst_linesize[plane];
335         for (y = 1; y < hp; y++) {
336             memcpy(p, p0, wp);
337             p += dst_linesize[plane];
338         }
339     }
340 }
341
342 /**
343  * Clip interval [x; x+w[ within [0; wmax[.
344  * The resulting w may be negative if the final interval is empty.
345  * dx, if not null, return the difference between in and out value of x.
346  */
347 static void clip_interval(int wmax, int *x, int *w, int *dx)
348 {
349     if (dx)
350         *dx = 0;
351     if (*x < 0) {
352         if (dx)
353             *dx = -*x;
354         *w += *x;
355         *x = 0;
356     }
357     if (*x + *w > wmax)
358         *w = wmax - *x;
359 }
360
361 /**
362  * Decompose w pixels starting at x
363  * into start + (w starting at x) + end
364  * with x and w aligned on multiples of 1<<sub.
365  */
366 static void subsampling_bounds(int sub, int *x, int *w, int *start, int *end)
367 {
368     int mask = (1 << sub) - 1;
369
370     *start = (-*x) & mask;
371     *x += *start;
372     *start = FFMIN(*start, *w);
373     *w -= *start;
374     *end = *w & mask;
375     *w >>= sub;
376 }
377
378 static int component_used(FFDrawContext *draw, int plane, int comp)
379 {
380     return (draw->comp_mask[plane] >> comp) & 1;
381 }
382
383 /* If alpha is in the [ 0 ; 0x1010101 ] range,
384    then alpha * value is in the [ 0 ; 0xFFFFFFFF ] range,
385    and >> 24 gives a correct rounding. */
386 static void blend_line(uint8_t *dst, unsigned src, unsigned alpha,
387                        int dx, int w, unsigned hsub, int left, int right)
388 {
389     unsigned asrc = alpha * src;
390     unsigned tau = 0x1010101 - alpha;
391     int x;
392
393     if (left) {
394         unsigned suba = (left * alpha) >> hsub;
395         *dst = (*dst * (0x1010101 - suba) + src * suba) >> 24;
396         dst += dx;
397     }
398     for (x = 0; x < w; x++) {
399         *dst = (*dst * tau + asrc) >> 24;
400         dst += dx;
401     }
402     if (right) {
403         unsigned suba = (right * alpha) >> hsub;
404         *dst = (*dst * (0x1010101 - suba) + src * suba) >> 24;
405     }
406 }
407
408 static void blend_line16(uint8_t *dst, unsigned src, unsigned alpha,
409                          int dx, int w, unsigned hsub, int left, int right)
410 {
411     unsigned asrc = alpha * src;
412     unsigned tau = 0x10001 - alpha;
413     int x;
414
415     if (left) {
416         unsigned suba = (left * alpha) >> hsub;
417         uint16_t value = AV_RL16(dst);
418         AV_WL16(dst, (value * (0x10001 - suba) + src * suba) >> 16);
419         dst += dx;
420     }
421     for (x = 0; x < w; x++) {
422         uint16_t value = AV_RL16(dst);
423         AV_WL16(dst, (value * tau + asrc) >> 16);
424         dst += dx;
425     }
426     if (right) {
427         unsigned suba = (right * alpha) >> hsub;
428         uint16_t value = AV_RL16(dst);
429         AV_WL16(dst, (value * (0x10001 - suba) + src * suba) >> 16);
430     }
431 }
432
433 void ff_blend_rectangle(FFDrawContext *draw, FFDrawColor *color,
434                         uint8_t *dst[], int dst_linesize[],
435                         int dst_w, int dst_h,
436                         int x0, int y0, int w, int h)
437 {
438     unsigned alpha, nb_planes, nb_comp, plane, comp;
439     int w_sub, h_sub, x_sub, y_sub, left, right, top, bottom, y;
440     uint8_t *p0, *p;
441
442     /* TODO optimize if alpha = 0xFF */
443     clip_interval(dst_w, &x0, &w, NULL);
444     clip_interval(dst_h, &y0, &h, NULL);
445     if (w <= 0 || h <= 0 || !color->rgba[3])
446         return;
447     if (draw->desc->comp[0].depth <= 8) {
448         /* 0x10203 * alpha + 2 is in the [ 2 ; 0x1010101 - 2 ] range */
449         alpha = 0x10203 * color->rgba[3] + 0x2;
450     } else {
451         /* 0x101 * alpha is in the [ 2 ; 0x1001] range */
452         alpha = 0x101 * color->rgba[3] + 0x2;
453     }
454     nb_planes = draw->nb_planes - !!(draw->desc->flags & AV_PIX_FMT_FLAG_ALPHA);
455     nb_planes += !nb_planes;
456     for (plane = 0; plane < nb_planes; plane++) {
457         nb_comp = draw->pixelstep[plane];
458         p0 = pointer_at(draw, dst, dst_linesize, plane, x0, y0);
459         w_sub = w;
460         h_sub = h;
461         x_sub = x0;
462         y_sub = y0;
463         subsampling_bounds(draw->hsub[plane], &x_sub, &w_sub, &left, &right);
464         subsampling_bounds(draw->vsub[plane], &y_sub, &h_sub, &top, &bottom);
465         for (comp = 0; comp < nb_comp; comp++) {
466             const int depth = draw->desc->comp[comp].depth;
467
468             if (!component_used(draw, plane, comp))
469                 continue;
470             p = p0 + comp;
471             if (top) {
472                 if (depth <= 8) {
473                     blend_line(p, color->comp[plane].u8[comp], alpha >> 1,
474                                draw->pixelstep[plane], w_sub,
475                                draw->hsub[plane], left, right);
476                 } else {
477                     blend_line16(p, color->comp[plane].u16[comp], alpha >> 1,
478                                  draw->pixelstep[plane], w_sub,
479                                  draw->hsub[plane], left, right);
480                 }
481                 p += dst_linesize[plane];
482             }
483             if (depth <= 8) {
484                 for (y = 0; y < h_sub; y++) {
485                     blend_line(p, color->comp[plane].u8[comp], alpha,
486                                draw->pixelstep[plane], w_sub,
487                                draw->hsub[plane], left, right);
488                     p += dst_linesize[plane];
489                 }
490             } else {
491                 for (y = 0; y < h_sub; y++) {
492                     blend_line16(p, color->comp[plane].u16[comp], alpha,
493                                  draw->pixelstep[plane], w_sub,
494                                  draw->hsub[plane], left, right);
495                     p += dst_linesize[plane];
496                 }
497             }
498             if (bottom) {
499                 if (depth <= 8) {
500                     blend_line(p, color->comp[plane].u8[comp], alpha >> 1,
501                                draw->pixelstep[plane], w_sub,
502                                draw->hsub[plane], left, right);
503                 } else {
504                     blend_line16(p, color->comp[plane].u16[comp], alpha >> 1,
505                                  draw->pixelstep[plane], w_sub,
506                                  draw->hsub[plane], left, right);
507                 }
508             }
509         }
510     }
511 }
512
513 static void blend_pixel16(uint8_t *dst, unsigned src, unsigned alpha,
514                           const uint8_t *mask, int mask_linesize, int l2depth,
515                           unsigned w, unsigned h, unsigned shift, unsigned xm0)
516 {
517     unsigned xm, x, y, t = 0;
518     unsigned xmshf = 3 - l2depth;
519     unsigned xmmod = 7 >> l2depth;
520     unsigned mbits = (1 << (1 << l2depth)) - 1;
521     unsigned mmult = 255 / mbits;
522     uint16_t value = AV_RL16(dst);
523
524     for (y = 0; y < h; y++) {
525         xm = xm0;
526         for (x = 0; x < w; x++) {
527             t += ((mask[xm >> xmshf] >> ((~xm & xmmod) << l2depth)) & mbits)
528                  * mmult;
529             xm++;
530         }
531         mask += mask_linesize;
532     }
533     alpha = (t >> shift) * alpha;
534     AV_WL16(dst, ((0x10001 - alpha) * value + alpha * src) >> 16);
535 }
536
537 static void blend_pixel(uint8_t *dst, unsigned src, unsigned alpha,
538                         const uint8_t *mask, int mask_linesize, int l2depth,
539                         unsigned w, unsigned h, unsigned shift, unsigned xm0)
540 {
541     unsigned xm, x, y, t = 0;
542     unsigned xmshf = 3 - l2depth;
543     unsigned xmmod = 7 >> l2depth;
544     unsigned mbits = (1 << (1 << l2depth)) - 1;
545     unsigned mmult = 255 / mbits;
546
547     for (y = 0; y < h; y++) {
548         xm = xm0;
549         for (x = 0; x < w; x++) {
550             t += ((mask[xm >> xmshf] >> ((~xm & xmmod) << l2depth)) & mbits)
551                  * mmult;
552             xm++;
553         }
554         mask += mask_linesize;
555     }
556     alpha = (t >> shift) * alpha;
557     *dst = ((0x1010101 - alpha) * *dst + alpha * src) >> 24;
558 }
559
560 static void blend_line_hv16(uint8_t *dst, int dst_delta,
561                             unsigned src, unsigned alpha,
562                             const uint8_t *mask, int mask_linesize, int l2depth, int w,
563                             unsigned hsub, unsigned vsub,
564                             int xm, int left, int right, int hband)
565 {
566     int x;
567
568     if (left) {
569         blend_pixel16(dst, src, alpha, mask, mask_linesize, l2depth,
570                       left, hband, hsub + vsub, xm);
571         dst += dst_delta;
572         xm += left;
573     }
574     for (x = 0; x < w; x++) {
575         blend_pixel16(dst, src, alpha, mask, mask_linesize, l2depth,
576                       1 << hsub, hband, hsub + vsub, xm);
577         dst += dst_delta;
578         xm += 1 << hsub;
579     }
580     if (right)
581         blend_pixel16(dst, src, alpha, mask, mask_linesize, l2depth,
582                       right, hband, hsub + vsub, xm);
583 }
584
585 static void blend_line_hv(uint8_t *dst, int dst_delta,
586                           unsigned src, unsigned alpha,
587                           const uint8_t *mask, int mask_linesize, int l2depth, int w,
588                           unsigned hsub, unsigned vsub,
589                           int xm, int left, int right, int hband)
590 {
591     int x;
592
593     if (left) {
594         blend_pixel(dst, src, alpha, mask, mask_linesize, l2depth,
595                     left, hband, hsub + vsub, xm);
596         dst += dst_delta;
597         xm += left;
598     }
599     for (x = 0; x < w; x++) {
600         blend_pixel(dst, src, alpha, mask, mask_linesize, l2depth,
601                     1 << hsub, hband, hsub + vsub, xm);
602         dst += dst_delta;
603         xm += 1 << hsub;
604     }
605     if (right)
606         blend_pixel(dst, src, alpha, mask, mask_linesize, l2depth,
607                     right, hband, hsub + vsub, xm);
608 }
609
610 void ff_blend_mask(FFDrawContext *draw, FFDrawColor *color,
611                    uint8_t *dst[], int dst_linesize[], int dst_w, int dst_h,
612                    const uint8_t *mask,  int mask_linesize, int mask_w, int mask_h,
613                    int l2depth, unsigned endianness, int x0, int y0)
614 {
615     unsigned alpha, nb_planes, nb_comp, plane, comp;
616     int xm0, ym0, w_sub, h_sub, x_sub, y_sub, left, right, top, bottom, y;
617     uint8_t *p0, *p;
618     const uint8_t *m;
619
620     clip_interval(dst_w, &x0, &mask_w, &xm0);
621     clip_interval(dst_h, &y0, &mask_h, &ym0);
622     mask += ym0 * mask_linesize;
623     if (mask_w <= 0 || mask_h <= 0 || !color->rgba[3])
624         return;
625     if (draw->desc->comp[0].depth <= 8) {
626         /* alpha is in the [ 0 ; 0x10203 ] range,
627            alpha * mask is in the [ 0 ; 0x1010101 - 4 ] range */
628         alpha = (0x10307 * color->rgba[3] + 0x3) >> 8;
629     } else {
630         alpha = (0x101 * color->rgba[3] + 0x2) >> 8;
631     }
632     nb_planes = draw->nb_planes - !!(draw->desc->flags & AV_PIX_FMT_FLAG_ALPHA);
633     nb_planes += !nb_planes;
634     for (plane = 0; plane < nb_planes; plane++) {
635         nb_comp = draw->pixelstep[plane];
636         p0 = pointer_at(draw, dst, dst_linesize, plane, x0, y0);
637         w_sub = mask_w;
638         h_sub = mask_h;
639         x_sub = x0;
640         y_sub = y0;
641         subsampling_bounds(draw->hsub[plane], &x_sub, &w_sub, &left, &right);
642         subsampling_bounds(draw->vsub[plane], &y_sub, &h_sub, &top, &bottom);
643         for (comp = 0; comp < nb_comp; comp++) {
644             const int depth = draw->desc->comp[comp].depth;
645
646             if (!component_used(draw, plane, comp))
647                 continue;
648             p = p0 + comp;
649             m = mask;
650             if (top) {
651                 if (depth <= 8) {
652                     blend_line_hv(p, draw->pixelstep[plane],
653                                   color->comp[plane].u8[comp], alpha,
654                                   m, mask_linesize, l2depth, w_sub,
655                                   draw->hsub[plane], draw->vsub[plane],
656                                   xm0, left, right, top);
657                 } else {
658                     blend_line_hv16(p, draw->pixelstep[plane],
659                                     color->comp[plane].u16[comp], alpha,
660                                     m, mask_linesize, l2depth, w_sub,
661                                     draw->hsub[plane], draw->vsub[plane],
662                                     xm0, left, right, top);
663                 }
664                 p += dst_linesize[plane];
665                 m += top * mask_linesize;
666             }
667             if (depth <= 8) {
668                 for (y = 0; y < h_sub; y++) {
669                     blend_line_hv(p, draw->pixelstep[plane],
670                                   color->comp[plane].u8[comp], alpha,
671                                   m, mask_linesize, l2depth, w_sub,
672                                   draw->hsub[plane], draw->vsub[plane],
673                                   xm0, left, right, 1 << draw->vsub[plane]);
674                     p += dst_linesize[plane];
675                     m += mask_linesize << draw->vsub[plane];
676                 }
677             } else {
678                 for (y = 0; y < h_sub; y++) {
679                     blend_line_hv16(p, draw->pixelstep[plane],
680                                     color->comp[plane].u16[comp], alpha,
681                                     m, mask_linesize, l2depth, w_sub,
682                                     draw->hsub[plane], draw->vsub[plane],
683                                     xm0, left, right, 1 << draw->vsub[plane]);
684                     p += dst_linesize[plane];
685                     m += mask_linesize << draw->vsub[plane];
686                 }
687             }
688             if (bottom) {
689                 if (depth <= 8) {
690                     blend_line_hv(p, draw->pixelstep[plane],
691                                   color->comp[plane].u8[comp], alpha,
692                                   m, mask_linesize, l2depth, w_sub,
693                                   draw->hsub[plane], draw->vsub[plane],
694                                   xm0, left, right, bottom);
695                 } else {
696                     blend_line_hv16(p, draw->pixelstep[plane],
697                                     color->comp[plane].u16[comp], alpha,
698                                     m, mask_linesize, l2depth, w_sub,
699                                     draw->hsub[plane], draw->vsub[plane],
700                                     xm0, left, right, bottom);
701                 }
702             }
703         }
704     }
705 }
706
707 int ff_draw_round_to_sub(FFDrawContext *draw, int sub_dir, int round_dir,
708                          int value)
709 {
710     unsigned shift = sub_dir ? draw->vsub_max : draw->hsub_max;
711
712     if (!shift)
713         return value;
714     if (round_dir >= 0)
715         value += round_dir ? (1 << shift) - 1 : 1 << (shift - 1);
716     return (value >> shift) << shift;
717 }
718
719 AVFilterFormats *ff_draw_supported_pixel_formats(unsigned flags)
720 {
721     enum AVPixelFormat i;
722     FFDrawContext draw;
723     AVFilterFormats *fmts = NULL;
724     int ret;
725
726     for (i = 0; av_pix_fmt_desc_get(i); i++)
727         if (ff_draw_init(&draw, i, flags) >= 0 &&
728             (ret = ff_add_format(&fmts, i)) < 0)
729             return NULL;
730     return fmts;
731 }