0243a17a1131503e596b694e1606dbb4c7016b9b
[ffmpeg.git] / libavfilter / drawutils.c
1 /*
2  * This file is part of FFmpeg.
3  *
4  * FFmpeg is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU Lesser General Public
6  * License as published by the Free Software Foundation; either
7  * version 2.1 of the License, or (at your option) any later version.
8  *
9  * FFmpeg is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * Lesser General Public License for more details.
13  *
14  * You should have received a copy of the GNU Lesser General Public
15  * License along with FFmpeg; if not, write to the Free Software
16  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
17  */
18
19 #include "libavutil/avutil.h"
20 #include "libavutil/colorspace.h"
21 #include "libavutil/pixdesc.h"
22 #include "drawutils.h"
23
24 enum { RED = 0, GREEN, BLUE, ALPHA };
25
26 int ff_fill_rgba_map(uint8_t *rgba_map, enum PixelFormat pix_fmt)
27 {
28     switch (pix_fmt) {
29     case PIX_FMT_0RGB:
30     case PIX_FMT_ARGB:  rgba_map[ALPHA] = 0; rgba_map[RED  ] = 1; rgba_map[GREEN] = 2; rgba_map[BLUE ] = 3; break;
31     case PIX_FMT_0BGR:
32     case PIX_FMT_ABGR:  rgba_map[ALPHA] = 0; rgba_map[BLUE ] = 1; rgba_map[GREEN] = 2; rgba_map[RED  ] = 3; break;
33     case PIX_FMT_RGB0:
34     case PIX_FMT_RGBA:
35     case PIX_FMT_RGB24: rgba_map[RED  ] = 0; rgba_map[GREEN] = 1; rgba_map[BLUE ] = 2; rgba_map[ALPHA] = 3; break;
36     case PIX_FMT_BGRA:
37     case PIX_FMT_BGR0:
38     case PIX_FMT_BGR24: rgba_map[BLUE ] = 0; rgba_map[GREEN] = 1; rgba_map[RED  ] = 2; rgba_map[ALPHA] = 3; break;
39     default:                    /* unsupported */
40         return AVERROR(EINVAL);
41     }
42     return 0;
43 }
44
45 int ff_fill_line_with_color(uint8_t *line[4], int pixel_step[4], int w, uint8_t dst_color[4],
46                             enum PixelFormat pix_fmt, uint8_t rgba_color[4],
47                             int *is_packed_rgba, uint8_t rgba_map_ptr[4])
48 {
49     uint8_t rgba_map[4] = {0};
50     int i;
51     const AVPixFmtDescriptor *pix_desc = &av_pix_fmt_descriptors[pix_fmt];
52     int hsub = pix_desc->log2_chroma_w;
53
54     *is_packed_rgba = ff_fill_rgba_map(rgba_map, pix_fmt) >= 0;
55
56     if (*is_packed_rgba) {
57         pixel_step[0] = (av_get_bits_per_pixel(pix_desc))>>3;
58         for (i = 0; i < 4; i++)
59             dst_color[rgba_map[i]] = rgba_color[i];
60
61         line[0] = av_malloc(w * pixel_step[0]);
62         for (i = 0; i < w; i++)
63             memcpy(line[0] + i * pixel_step[0], dst_color, pixel_step[0]);
64         if (rgba_map_ptr)
65             memcpy(rgba_map_ptr, rgba_map, sizeof(rgba_map[0]) * 4);
66     } else {
67         int plane;
68
69         dst_color[0] = RGB_TO_Y_CCIR(rgba_color[0], rgba_color[1], rgba_color[2]);
70         dst_color[1] = RGB_TO_U_CCIR(rgba_color[0], rgba_color[1], rgba_color[2], 0);
71         dst_color[2] = RGB_TO_V_CCIR(rgba_color[0], rgba_color[1], rgba_color[2], 0);
72         dst_color[3] = rgba_color[3];
73
74         for (plane = 0; plane < 4; plane++) {
75             int line_size;
76             int hsub1 = (plane == 1 || plane == 2) ? hsub : 0;
77
78             pixel_step[plane] = 1;
79             line_size = (w >> hsub1) * pixel_step[plane];
80             line[plane] = av_malloc(line_size);
81             memset(line[plane], dst_color[plane], line_size);
82         }
83     }
84
85     return 0;
86 }
87
88 void ff_draw_rectangle(uint8_t *dst[4], int dst_linesize[4],
89                        uint8_t *src[4], int pixelstep[4],
90                        int hsub, int vsub, int x, int y, int w, int h)
91 {
92     int i, plane;
93     uint8_t *p;
94
95     for (plane = 0; plane < 4 && dst[plane]; plane++) {
96         int hsub1 = plane == 1 || plane == 2 ? hsub : 0;
97         int vsub1 = plane == 1 || plane == 2 ? vsub : 0;
98
99         p = dst[plane] + (y >> vsub1) * dst_linesize[plane];
100         for (i = 0; i < (h >> vsub1); i++) {
101             memcpy(p + (x >> hsub1) * pixelstep[plane],
102                    src[plane], (w >> hsub1) * pixelstep[plane]);
103             p += dst_linesize[plane];
104         }
105     }
106 }
107
108 void ff_copy_rectangle(uint8_t *dst[4], int dst_linesize[4],
109                        uint8_t *src[4], int src_linesize[4], int pixelstep[4],
110                        int hsub, int vsub, int x, int y, int y2, int w, int h)
111 {
112     int i, plane;
113     uint8_t *p;
114
115     for (plane = 0; plane < 4 && dst[plane]; plane++) {
116         int hsub1 = plane == 1 || plane == 2 ? hsub : 0;
117         int vsub1 = plane == 1 || plane == 2 ? vsub : 0;
118
119         p = dst[plane] + (y >> vsub1) * dst_linesize[plane];
120         for (i = 0; i < (h >> vsub1); i++) {
121             memcpy(p + (x >> hsub1) * pixelstep[plane],
122                    src[plane] + src_linesize[plane]*(i+(y2>>vsub1)), (w >> hsub1) * pixelstep[plane]);
123             p += dst_linesize[plane];
124         }
125     }
126 }
127
128 int ff_draw_init(FFDrawContext *draw, enum PixelFormat format, unsigned flags)
129 {
130     const AVPixFmtDescriptor *desc = &av_pix_fmt_descriptors[format];
131     const AVComponentDescriptor *c;
132     unsigned i, nb_planes = 0;
133     int pixelstep[MAX_PLANES] = { 0 };
134
135     if (desc->flags & ~(PIX_FMT_PLANAR | PIX_FMT_RGB))
136         return AVERROR(ENOSYS);
137     for (i = 0; i < desc->nb_components; i++) {
138         c = &desc->comp[i];
139         /* for now, only 8-bits formats */
140         if (c->depth_minus1 != 8 - 1)
141             return AVERROR(ENOSYS);
142         if (c->plane >= MAX_PLANES)
143             return AVERROR(ENOSYS);
144         /* strange interleaving */
145         if (pixelstep[c->plane] != 0 &&
146             pixelstep[c->plane] != c->step_minus1 + 1)
147             return AVERROR(ENOSYS);
148         pixelstep[c->plane] = c->step_minus1 + 1;
149         nb_planes = FFMAX(nb_planes, c->plane + 1);
150     }
151     if ((desc->log2_chroma_w || desc->log2_chroma_h) && nb_planes < 3)
152         return AVERROR(ENOSYS); /* exclude NV12 and NV21 */
153     memset(draw, 0, sizeof(*draw));
154     draw->desc      = desc;
155     draw->format    = format;
156     draw->nb_planes = nb_planes;
157     memcpy(draw->pixelstep, pixelstep, sizeof(draw->pixelstep));
158     if (nb_planes >= 3 && !(desc->flags & PIX_FMT_RGB)) {
159         draw->hsub[1] = draw->hsub[2] = draw->hsub_max = desc->log2_chroma_w;
160         draw->vsub[1] = draw->vsub[2] = draw->vsub_max = desc->log2_chroma_h;
161     }
162     return 0;
163 }
164
165 void ff_draw_color(FFDrawContext *draw, FFDrawColor *color, uint8_t rgba[4])
166 {
167     unsigned i;
168     uint8_t rgba_map[4];
169
170     if ((draw->desc->flags & PIX_FMT_RGB) && draw->nb_planes == 1 &&
171         ff_fill_rgba_map(rgba_map, draw->format) >= 0) {
172         for (i = 0; i < 4; i++)
173             color->comp[0].u8[rgba_map[i]] = rgba[i];
174     } else if (draw->nb_planes == 3 || draw->nb_planes == 4) {
175         /* assume YUV */
176         color->comp[0].u8[0] = RGB_TO_Y_CCIR(rgba[0], rgba[1], rgba[2]);
177         color->comp[1].u8[0] = RGB_TO_U_CCIR(rgba[0], rgba[1], rgba[2], 0);
178         color->comp[2].u8[0] = RGB_TO_V_CCIR(rgba[0], rgba[1], rgba[2], 0);
179         color->comp[3].u8[0] = rgba[3];
180     } else if (draw->format == PIX_FMT_GRAY8 || draw->format == PIX_FMT_GRAY8A) {
181         color->comp[0].u8[0] = RGB_TO_Y_CCIR(rgba[0], rgba[1], rgba[2]);
182         color->comp[1].u8[0] = rgba[3];
183     } else {
184         av_log(NULL, AV_LOG_WARNING,
185                "Color conversion not implemented for %s\n", draw->desc->name);
186         memset(color, 128, sizeof(*color));
187     }
188 }
189
190 static uint8_t *pointer_at(FFDrawContext *draw, uint8_t *data[], int linesize[],
191                            int plane, int x, int y)
192 {
193     return data[plane] +
194            (y >> draw->vsub[plane]) * linesize[plane] +
195            (x >> draw->hsub[plane]) * draw->pixelstep[plane];
196 }
197
198 void ff_copy_rectangle2(FFDrawContext *draw,
199                         uint8_t *dst[], int dst_linesize[],
200                         uint8_t *src[], int src_linesize[],
201                         int dst_x, int dst_y, int src_x, int src_y,
202                         int w, int h)
203 {
204     int plane, y, wp, hp;
205     uint8_t *p, *q;
206
207     for (plane = 0; plane < draw->nb_planes; plane++) {
208         p = pointer_at(draw, src, src_linesize, plane, src_x, src_y);
209         q = pointer_at(draw, dst, dst_linesize, plane, dst_x, dst_y);
210         wp = (w >> draw->hsub[plane]) * draw->pixelstep[plane];
211         hp = (h >> draw->vsub[plane]);
212         for (y = 0; y < hp; y++) {
213             memcpy(q, p, wp);
214             p += src_linesize[plane];
215             q += dst_linesize[plane];
216         }
217     }
218 }
219
220 void ff_fill_rectangle(FFDrawContext *draw, FFDrawColor *color,
221                        uint8_t *dst[], int dst_linesize[],
222                        int dst_x, int dst_y, int w, int h)
223 {
224     int plane, x, y, wp, hp;
225     uint8_t *p0, *p;
226
227     for (plane = 0; plane < draw->nb_planes; plane++) {
228         p0 = pointer_at(draw, dst, dst_linesize, plane, dst_x, dst_y);
229         wp = (w >> draw->hsub[plane]);
230         hp = (h >> draw->vsub[plane]);
231         if (!hp)
232             return;
233         p = p0;
234         /* copy first line from color */
235         for (x = 0; x < wp; x++) {
236             memcpy(p, color->comp[plane].u8, draw->pixelstep[plane]);
237             p += draw->pixelstep[plane];
238         }
239         wp *= draw->pixelstep[plane];
240         /* copy next lines from first line */
241         p = p0 + dst_linesize[plane];
242         for (y = 1; y < hp; y++) {
243             memcpy(p, p0, wp);
244             p += dst_linesize[plane];
245         }
246     }
247 }
248
249 int ff_draw_round_to_sub(FFDrawContext *draw, int sub_dir, int round_dir,
250                          int value)
251 {
252     unsigned shift = sub_dir ? draw->vsub_max : draw->hsub_max;
253
254     if (!shift)
255         return value;
256     if (round_dir >= 0)
257         value += round_dir ? (1 << shift) - 1 : 1 << (shift - 1);
258     return (value >> shift) << shift;
259 }
260
261 AVFilterFormats *ff_draw_supported_pixel_formats(unsigned flags)
262 {
263     enum PixelFormat i, pix_fmts[PIX_FMT_NB + 1];
264     unsigned n = 0;
265     FFDrawContext draw;
266
267     for (i = 0; i < PIX_FMT_NB; i++)
268         if (ff_draw_init(&draw, i, flags) >= 0)
269             pix_fmts[n++] = i;
270     pix_fmts[n++] = PIX_FMT_NONE;
271     return avfilter_make_format_list(pix_fmts);
272 }
273
274 #ifdef TEST
275
276 #undef printf
277
278 int main(void)
279 {
280     enum PixelFormat f;
281     const AVPixFmtDescriptor *desc;
282     FFDrawContext draw;
283     FFDrawColor color;
284     int r, i;
285
286     for (f = 0; f < PIX_FMT_NB; f++) {
287         desc = &av_pix_fmt_descriptors[f];
288         if (!desc->name)
289             continue;
290         printf("Testing %s...%*s", desc->name,
291                (int)(16 - strlen(desc->name)), "");
292         r = ff_draw_init(&draw, f, 0);
293         if (r < 0) {
294             char buf[128];
295             av_strerror(r, buf, sizeof(buf));
296             printf("no: %s\n", buf);
297             continue;
298         }
299         ff_draw_color(&draw, &color, (uint8_t[]) { 1, 0, 0, 1 });
300         for (i = 0; i < sizeof(color); i++)
301             if (((uint8_t *)&color)[i] != 128)
302                 break;
303         if (i == sizeof(color)) {
304             printf("fallback color\n");
305             continue;
306         }
307         printf("ok\n");
308     }
309     return 0;
310 }
311
312 #endif