1 /*
2 * Copyright (c) 2020 Paul B Mahol
3 *
4 * This file is part of FFmpeg.
5 *
6 * FFmpeg is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2.1 of the License, or (at your option) any later version.
10 *
11 * FFmpeg is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
15 *
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with FFmpeg; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
19 */
20
21 #include "libavutil/imgutils.h"
22 #include "libavutil/opt.h"
23 #include "libavutil/pixdesc.h"
24 #include "avfilter.h"
25 #include "formats.h"
26 #include "internal.h"
27 #include "video.h"
28
29 typedef struct DBlurContext {
30 const AVClass *class;
31
32 float angle;
33 float radius;
34 int planes;
35
36 float b0, b1, q, c, R3;
37
38 int depth;
39 int planewidth[4];
40 int planeheight[4];
41 float *buffer;
42 int nb_planes;
43 } DBlurContext;
44
45 #define OFFSET(x) offsetof(DBlurContext, x)
46 #define FLAGS AV_OPT_FLAG_VIDEO_PARAM|AV_OPT_FLAG_FILTERING_PARAM|AV_OPT_FLAG_RUNTIME_PARAM
47
48 static const AVOption dblur_options[] = {
49 { "angle", "set angle", OFFSET(angle), AV_OPT_TYPE_FLOAT, {.dbl=45}, 0.0, 360, FLAGS },
50 { "radius", "set radius", OFFSET(radius), AV_OPT_TYPE_FLOAT, {.dbl=5}, 1, 8192, FLAGS },
51 { "planes", "set planes to filter", OFFSET(planes), AV_OPT_TYPE_INT, {.i64=0xF}, 0, 0xF, FLAGS },
52 { NULL }
53 };
54
55 AVFILTER_DEFINE_CLASS(dblur);
56
57 #define f(n, m) (dst[(n) * width + (m)])
58
filter_horizontally(AVFilterContext * ctx,int width,int height)59 static int filter_horizontally(AVFilterContext *ctx, int width, int height)
60 {
61 DBlurContext *s = ctx->priv;
62 const float b0 = s->b0;
63 const float b1 = s->b1;
64 const float q = s->q;
65 const float c = s->c;
66 float *dst = s->buffer;
67 float g;
68
69 if (s->R3 > 0) {
70 for (int y = 1; y < height - 1; y++) {
71 g = q * f(0, 0) + c * f(0, 0);
72 for (int x = 0; x < width; x++) {
73 f(y, x) = b0 * f(y, x) + b1 * f(y - 1, x) + g;
74 g = q * f(y, x) + c * f(y - 1, x);
75 }
76 }
77
78 for (int y = height - 2; y >= 0; y--) {
79 g = q * f(y, width - 1) + c * f(y, width - 1);
80 for (int x = width - 1; x >= 0; x--) {
81 f(y, x) = b0 * f(y, x) + b1 * f(y + 1, x) + g;
82 g = q * f(y, x) + c * f(y + 1, x);
83 }
84 }
85 } else {
86 for (int y = 1; y < height - 1; y++) {
87 g = q * f(0, width - 1) + c * f(0, width - 1);
88 for (int x = width - 1; x >= 0; x--) {
89 f(y, x) = b0 * f(y, x) + b1 * f(y - 1, x) + g;
90 g = q * f(y, x) + c * f(y - 1, x);
91 }
92 }
93
94 for (int y = height - 2; y >= 0; y--) {
95 g = q * f(y, 0) + c * f(y, 0);
96 for (int x = 0; x < width; x++) {
97 f(y, x) = b0 * f(y, x) + b1 * f(y + 1, x) + g;
98 g = q * f(y, x) + c * f(y + 1, x);
99 }
100 }
101 }
102
103 return 0;
104 }
105
diriir2d(AVFilterContext * ctx,int plane)106 static void diriir2d(AVFilterContext *ctx, int plane)
107 {
108 DBlurContext *s = ctx->priv;
109 const int width = s->planewidth[plane];
110 const int height = s->planeheight[plane];
111
112 filter_horizontally(ctx, width, height);
113 }
114
query_formats(AVFilterContext * ctx)115 static int query_formats(AVFilterContext *ctx)
116 {
117 static const enum AVPixelFormat pix_fmts[] = {
118 AV_PIX_FMT_YUVA444P, AV_PIX_FMT_YUV444P, AV_PIX_FMT_YUV440P,
119 AV_PIX_FMT_YUVJ444P, AV_PIX_FMT_YUVJ440P,
120 AV_PIX_FMT_YUVA422P, AV_PIX_FMT_YUV422P, AV_PIX_FMT_YUVA420P, AV_PIX_FMT_YUV420P,
121 AV_PIX_FMT_YUVJ422P, AV_PIX_FMT_YUVJ420P,
122 AV_PIX_FMT_YUVJ411P, AV_PIX_FMT_YUV411P, AV_PIX_FMT_YUV410P,
123 AV_PIX_FMT_YUV420P9, AV_PIX_FMT_YUV422P9, AV_PIX_FMT_YUV444P9,
124 AV_PIX_FMT_YUV420P10, AV_PIX_FMT_YUV422P10, AV_PIX_FMT_YUV444P10,
125 AV_PIX_FMT_YUV420P12, AV_PIX_FMT_YUV422P12, AV_PIX_FMT_YUV444P12, AV_PIX_FMT_YUV440P12,
126 AV_PIX_FMT_YUV420P14, AV_PIX_FMT_YUV422P14, AV_PIX_FMT_YUV444P14,
127 AV_PIX_FMT_YUV420P16, AV_PIX_FMT_YUV422P16, AV_PIX_FMT_YUV444P16,
128 AV_PIX_FMT_YUVA420P9, AV_PIX_FMT_YUVA422P9, AV_PIX_FMT_YUVA444P9,
129 AV_PIX_FMT_YUVA420P10, AV_PIX_FMT_YUVA422P10, AV_PIX_FMT_YUVA444P10,
130 AV_PIX_FMT_YUVA422P12, AV_PIX_FMT_YUVA444P12,
131 AV_PIX_FMT_YUVA420P16, AV_PIX_FMT_YUVA422P16, AV_PIX_FMT_YUVA444P16,
132 AV_PIX_FMT_GBRP, AV_PIX_FMT_GBRP9, AV_PIX_FMT_GBRP10,
133 AV_PIX_FMT_GBRP12, AV_PIX_FMT_GBRP14, AV_PIX_FMT_GBRP16,
134 AV_PIX_FMT_GBRAP, AV_PIX_FMT_GBRAP10, AV_PIX_FMT_GBRAP12, AV_PIX_FMT_GBRAP16,
135 AV_PIX_FMT_GRAY8, AV_PIX_FMT_GRAY9, AV_PIX_FMT_GRAY10, AV_PIX_FMT_GRAY12, AV_PIX_FMT_GRAY14, AV_PIX_FMT_GRAY16,
136 AV_PIX_FMT_NONE
137 };
138
139 return ff_set_common_formats(ctx, ff_make_format_list(pix_fmts));
140 }
141
config_input(AVFilterLink * inlink)142 static int config_input(AVFilterLink *inlink)
143 {
144 const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(inlink->format);
145 DBlurContext *s = inlink->dst->priv;
146
147 s->depth = desc->comp[0].depth;
148 s->planewidth[1] = s->planewidth[2] = AV_CEIL_RSHIFT(inlink->w, desc->log2_chroma_w);
149 s->planewidth[0] = s->planewidth[3] = inlink->w;
150 s->planeheight[1] = s->planeheight[2] = AV_CEIL_RSHIFT(inlink->h, desc->log2_chroma_h);
151 s->planeheight[0] = s->planeheight[3] = inlink->h;
152
153 s->nb_planes = av_pix_fmt_count_planes(inlink->format);
154
155 s->buffer = av_malloc_array(FFALIGN(inlink->w, 16), FFALIGN(inlink->h, 16) * sizeof(*s->buffer));
156 if (!s->buffer)
157 return AVERROR(ENOMEM);
158
159 return 0;
160 }
161
set_params(DBlurContext * s,float angle,float r)162 static void set_params(DBlurContext *s, float angle, float r)
163 {
164 float mu, nu, R1, R2, w1, w2;
165 float a0, a1, a2, a3;
166
167 angle = angle * M_PI / 180.f;
168
169 mu = cosf(angle);
170 nu = sinf(angle);
171 R1 = (mu * r) * (mu * r);
172 R2 = (nu * r) * (nu * r);
173 s->R3 = mu * nu * r * r;
174 w1 = sqrtf(0.25f + R1);
175 w2 = sqrtf(0.25f + R2);
176 a0 = (w1 + 0.5f) * (w2 + 0.5f) - fabsf(s->R3);
177 a1 = 0.5f + w2 - a0;
178 a2 = 0.5f + w1 - a0;
179 a3 = a0 - w1 - w2;
180 s->b0 = 1.f / a0;
181 s->b1 = -a2 / a0;
182 s->q = -a1 / a0;
183 s->c = -a3 / a0;
184 }
185
filter_frame(AVFilterLink * inlink,AVFrame * in)186 static int filter_frame(AVFilterLink *inlink, AVFrame *in)
187 {
188 AVFilterContext *ctx = inlink->dst;
189 DBlurContext *s = ctx->priv;
190 AVFilterLink *outlink = ctx->outputs[0];
191 AVFrame *out;
192 int plane;
193
194 set_params(s, s->angle, s->radius);
195
196 if (av_frame_is_writable(in)) {
197 out = in;
198 } else {
199 out = ff_get_video_buffer(outlink, outlink->w, outlink->h);
200 if (!out) {
201 av_frame_free(&in);
202 return AVERROR(ENOMEM);
203 }
204 av_frame_copy_props(out, in);
205 }
206
207 for (plane = 0; plane < s->nb_planes; plane++) {
208 const int height = s->planeheight[plane];
209 const int width = s->planewidth[plane];
210 float *bptr = s->buffer;
211 const uint8_t *src = in->data[plane];
212 const uint16_t *src16 = (const uint16_t *)in->data[plane];
213 uint8_t *dst = out->data[plane];
214 uint16_t *dst16 = (uint16_t *)out->data[plane];
215 int y, x;
216
217 if (!(s->planes & (1 << plane))) {
218 if (out != in)
219 av_image_copy_plane(out->data[plane], out->linesize[plane],
220 in->data[plane], in->linesize[plane],
221 width * ((s->depth + 7) / 8), height);
222 continue;
223 }
224
225 if (s->depth == 8) {
226 for (y = 0; y < height; y++) {
227 for (x = 0; x < width; x++) {
228 bptr[x] = src[x];
229 }
230 bptr += width;
231 src += in->linesize[plane];
232 }
233 } else {
234 for (y = 0; y < height; y++) {
235 for (x = 0; x < width; x++) {
236 bptr[x] = src16[x];
237 }
238 bptr += width;
239 src16 += in->linesize[plane] / 2;
240 }
241 }
242
243 diriir2d(ctx, plane);
244
245 bptr = s->buffer;
246 if (s->depth == 8) {
247 for (y = 0; y < height; y++) {
248 for (x = 0; x < width; x++) {
249 dst[x] = bptr[x];
250 }
251 bptr += width;
252 dst += out->linesize[plane];
253 }
254 } else {
255 for (y = 0; y < height; y++) {
256 for (x = 0; x < width; x++) {
257 dst16[x] = bptr[x];
258 }
259 bptr += width;
260 dst16 += out->linesize[plane] / 2;
261 }
262 }
263 }
264
265 if (out != in)
266 av_frame_free(&in);
267 return ff_filter_frame(outlink, out);
268 }
269
uninit(AVFilterContext * ctx)270 static av_cold void uninit(AVFilterContext *ctx)
271 {
272 DBlurContext *s = ctx->priv;
273
274 av_freep(&s->buffer);
275 }
276
277 static const AVFilterPad dblur_inputs[] = {
278 {
279 .name = "default",
280 .type = AVMEDIA_TYPE_VIDEO,
281 .config_props = config_input,
282 .filter_frame = filter_frame,
283 },
284 { NULL }
285 };
286
287 static const AVFilterPad dblur_outputs[] = {
288 {
289 .name = "default",
290 .type = AVMEDIA_TYPE_VIDEO,
291 },
292 { NULL }
293 };
294
295 AVFilter ff_vf_dblur = {
296 .name = "dblur",
297 .description = NULL_IF_CONFIG_SMALL("Apply Directional Blur filter."),
298 .priv_size = sizeof(DBlurContext),
299 .priv_class = &dblur_class,
300 .uninit = uninit,
301 .query_formats = query_formats,
302 .inputs = dblur_inputs,
303 .outputs = dblur_outputs,
304 .flags = AVFILTER_FLAG_SUPPORT_TIMELINE_GENERIC,
305 .process_command = ff_filter_process_command,
306 };
307