FFmpeg coverage


Directory: ../../../ffmpeg/
File: src/libavfilter/vf_bm3d.c
Date: 2024-02-16 17:37:06
Exec Total Coverage
Lines: 0 544 0.0%
Functions: 0 22 0.0%
Branches: 0 274 0.0%

Line Branch Exec Source
1 /*
2 * Copyright (c) 2015-2016 mawen1250
3 * Copyright (c) 2018 Paul B Mahol
4 *
5 * This file is part of FFmpeg.
6 *
7 * Permission is hereby granted, free of charge, to any person obtaining a copy
8 * of this software and associated documentation files (the "Software"), to deal
9 * in the Software without restriction, including without limitation the rights
10 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
11 * copies of the Software, and to permit persons to whom the Software is
12 * furnished to do so, subject to the following conditions:
13 *
14 * The above copyright notice and this permission notice shall be included in all
15 * copies or substantial portions of the Software.
16 *
17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
20 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
21 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
22 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
23 * SOFTWARE.
24 */
25
26 /**
27 * @todo
28 * - opponent color space
29 * - temporal support
30 */
31
32 #include <float.h>
33
34 #include "libavutil/cpu.h"
35 #include "libavutil/imgutils.h"
36 #include "libavutil/opt.h"
37 #include "libavutil/pixdesc.h"
38 #include "libavutil/tx.h"
39 #include "avfilter.h"
40 #include "filters.h"
41 #include "framesync.h"
42 #include "internal.h"
43 #include "video.h"
44
45 #define MAX_NB_THREADS 32
46
47 enum FilterModes {
48 BASIC,
49 FINAL,
50 NB_MODES,
51 };
52
53 typedef struct ThreadData {
54 const uint8_t *src;
55 int src_linesize;
56 const uint8_t *ref;
57 int ref_linesize;
58 int plane;
59 } ThreadData;
60
61 typedef struct PosCode {
62 int x, y;
63 } PosCode;
64
65 typedef struct PosPairCode {
66 double score;
67 int x, y;
68 } PosPairCode;
69
70 typedef struct SliceContext {
71 AVTXContext *gdctf, *gdcti;
72 av_tx_fn tx_fn_g, itx_fn_g;
73 AVTXContext *dctf, *dcti;
74 av_tx_fn tx_fn, itx_fn;
75 float *bufferh;
76 float *buffert;
77 float *bufferv;
78 float *bufferz;
79 float *buffer;
80 float *rbufferh;
81 float *rbufferv;
82 float *rbufferz;
83 float *rbuffer;
84 float *num, *den;
85 PosPairCode match_blocks[256];
86 int nb_match_blocks;
87 PosCode *search_positions;
88 } SliceContext;
89
90 typedef struct BM3DContext {
91 const AVClass *class;
92
93 float sigma;
94 int block_size;
95 int block_step;
96 int group_size;
97 int bm_range;
98 int bm_step;
99 float th_mse;
100 float hard_threshold;
101 int mode;
102 int ref;
103 int planes;
104
105 int depth;
106 int max;
107 int nb_planes;
108 int planewidth[4];
109 int planeheight[4];
110 int pblock_size;
111 int pgroup_size;
112
113 SliceContext slices[MAX_NB_THREADS];
114
115 FFFrameSync fs;
116 int nb_threads;
117
118 void (*get_block_row)(const uint8_t *srcp, int src_linesize,
119 int y, int x, int block_size, float *dst);
120 double (*do_block_ssd)(struct BM3DContext *s, PosCode *pos,
121 const uint8_t *src, int src_stride,
122 int r_y, int r_x);
123 void (*do_output)(struct BM3DContext *s, uint8_t *dst, int dst_linesize,
124 int plane, int nb_jobs);
125 void (*block_filtering)(struct BM3DContext *s,
126 const uint8_t *src, int src_linesize,
127 const uint8_t *ref, int ref_linesize,
128 int y, int x, int plane, int jobnr);
129 } BM3DContext;
130
131 #define OFFSET(x) offsetof(BM3DContext, x)
132 #define FLAGS AV_OPT_FLAG_FILTERING_PARAM|AV_OPT_FLAG_VIDEO_PARAM
133
134 static const AVOption bm3d_options[] = {
135 { "sigma", "set denoising strength",
136 OFFSET(sigma), AV_OPT_TYPE_FLOAT, {.dbl=1}, 0, 99999.9, FLAGS },
137 { "block", "set size of local patch",
138 OFFSET(block_size), AV_OPT_TYPE_INT, {.i64=16}, 8, 64, FLAGS },
139 { "bstep", "set sliding step for processing blocks",
140 OFFSET(block_step), AV_OPT_TYPE_INT, {.i64=4}, 1, 64, FLAGS },
141 { "group", "set maximal number of similar blocks",
142 OFFSET(group_size), AV_OPT_TYPE_INT, {.i64=1}, 1, 256, FLAGS },
143 { "range", "set block matching range",
144 OFFSET(bm_range), AV_OPT_TYPE_INT, {.i64=9}, 1, INT32_MAX, FLAGS },
145 { "mstep", "set step for block matching",
146 OFFSET(bm_step), AV_OPT_TYPE_INT, {.i64=1}, 1, 64, FLAGS },
147 { "thmse", "set threshold of mean square error for block matching",
148 OFFSET(th_mse), AV_OPT_TYPE_FLOAT, {.dbl=0}, 0, INT32_MAX, FLAGS },
149 { "hdthr", "set hard threshold for 3D transfer domain",
150 OFFSET(hard_threshold), AV_OPT_TYPE_FLOAT, {.dbl=2.7}, 0, INT32_MAX, FLAGS },
151 { "estim", "set filtering estimation mode",
152 OFFSET(mode), AV_OPT_TYPE_INT, {.i64=BASIC}, 0, NB_MODES-1, FLAGS, .unit = "mode" },
153 { "basic", "basic estimate",
154 0, AV_OPT_TYPE_CONST, {.i64=BASIC}, 0, 0, FLAGS, .unit = "mode" },
155 { "final", "final estimate",
156 0, AV_OPT_TYPE_CONST, {.i64=FINAL}, 0, 0, FLAGS, .unit = "mode" },
157 { "ref", "have reference stream",
158 OFFSET(ref), AV_OPT_TYPE_BOOL, {.i64=0}, 0, 1, FLAGS },
159 { "planes", "set planes to filter",
160 OFFSET(planes), AV_OPT_TYPE_INT, {.i64=7}, 0, 15, FLAGS },
161 { NULL }
162 };
163
164 AVFILTER_DEFINE_CLASS(bm3d);
165
166 static const enum AVPixelFormat pix_fmts[] = {
167 AV_PIX_FMT_GRAY8, AV_PIX_FMT_GRAY9, AV_PIX_FMT_GRAY10,
168 AV_PIX_FMT_GRAY12, AV_PIX_FMT_GRAY14, AV_PIX_FMT_GRAY16,
169 AV_PIX_FMT_YUV410P, AV_PIX_FMT_YUV411P,
170 AV_PIX_FMT_YUV420P, AV_PIX_FMT_YUV422P,
171 AV_PIX_FMT_YUV440P, AV_PIX_FMT_YUV444P,
172 AV_PIX_FMT_YUVJ420P, AV_PIX_FMT_YUVJ422P,
173 AV_PIX_FMT_YUVJ440P, AV_PIX_FMT_YUVJ444P,
174 AV_PIX_FMT_YUVJ411P,
175 AV_PIX_FMT_YUV420P9, AV_PIX_FMT_YUV422P9, AV_PIX_FMT_YUV444P9,
176 AV_PIX_FMT_YUV420P10, AV_PIX_FMT_YUV422P10, AV_PIX_FMT_YUV444P10,
177 AV_PIX_FMT_YUV440P10,
178 AV_PIX_FMT_YUV444P12, AV_PIX_FMT_YUV422P12, AV_PIX_FMT_YUV420P12,
179 AV_PIX_FMT_YUV440P12,
180 AV_PIX_FMT_YUV444P14, AV_PIX_FMT_YUV422P14, AV_PIX_FMT_YUV420P14,
181 AV_PIX_FMT_YUV420P16, AV_PIX_FMT_YUV422P16, AV_PIX_FMT_YUV444P16,
182 AV_PIX_FMT_GBRP, AV_PIX_FMT_GBRP9, AV_PIX_FMT_GBRP10,
183 AV_PIX_FMT_GBRP12, AV_PIX_FMT_GBRP14, AV_PIX_FMT_GBRP16,
184 AV_PIX_FMT_YUVA420P, AV_PIX_FMT_YUVA422P, AV_PIX_FMT_YUVA444P,
185 AV_PIX_FMT_YUVA444P9, AV_PIX_FMT_YUVA444P10, AV_PIX_FMT_YUVA444P12, AV_PIX_FMT_YUVA444P16,
186 AV_PIX_FMT_YUVA422P9, AV_PIX_FMT_YUVA422P10, AV_PIX_FMT_YUVA422P12, AV_PIX_FMT_YUVA422P16,
187 AV_PIX_FMT_YUVA420P9, AV_PIX_FMT_YUVA420P10, AV_PIX_FMT_YUVA420P16,
188 AV_PIX_FMT_GBRAP, AV_PIX_FMT_GBRAP10, AV_PIX_FMT_GBRAP12, AV_PIX_FMT_GBRAP16,
189 AV_PIX_FMT_NONE
190 };
191
192 static int do_search_boundary(int pos, int plane_boundary, int search_range, int search_step)
193 {
194 int search_boundary;
195
196 search_range = search_range / search_step * search_step;
197
198 if (pos == plane_boundary) {
199 search_boundary = plane_boundary;
200 } else if (pos > plane_boundary) {
201 search_boundary = pos - search_range;
202
203 while (search_boundary < plane_boundary) {
204 search_boundary += search_step;
205 }
206 } else {
207 search_boundary = pos + search_range;
208
209 while (search_boundary > plane_boundary) {
210 search_boundary -= search_step;
211 }
212 }
213
214 return search_boundary;
215 }
216
217 static int search_boundary(int plane_boundary, int search_range, int search_step, int vertical, int y, int x)
218 {
219 return do_search_boundary(vertical ? y : x, plane_boundary, search_range, search_step);
220 }
221
222 static int cmp_scores(const void *a, const void *b)
223 {
224 const struct PosPairCode *pair1 = a;
225 const struct PosPairCode *pair2 = b;
226 return FFDIFFSIGN(pair1->score, pair2->score);
227 }
228
229 static double do_block_ssd(BM3DContext *s, PosCode *pos, const uint8_t *src, int src_stride, int r_y, int r_x)
230 {
231 const uint8_t *srcp = src + pos->y * src_stride + pos->x;
232 const uint8_t *refp = src + r_y * src_stride + r_x;
233 const int block_size = s->block_size;
234 double dist = 0.;
235 int x, y;
236
237 for (y = 0; y < block_size; y++) {
238 for (x = 0; x < block_size; x++) {
239 double temp = refp[x] - srcp[x];
240 dist += temp * temp;
241 }
242
243 srcp += src_stride;
244 refp += src_stride;
245 }
246
247 return dist;
248 }
249
250 static double do_block_ssd16(BM3DContext *s, PosCode *pos, const uint8_t *src, int src_stride, int r_y, int r_x)
251 {
252 const uint16_t *srcp = (uint16_t *)src + pos->y * src_stride / 2 + pos->x;
253 const uint16_t *refp = (uint16_t *)src + r_y * src_stride / 2 + r_x;
254 const int block_size = s->block_size;
255 double dist = 0.;
256 int x, y;
257
258 for (y = 0; y < block_size; y++) {
259 for (x = 0; x < block_size; x++) {
260 double temp = refp[x] - srcp[x];
261 dist += temp * temp;
262 }
263
264 srcp += src_stride / 2;
265 refp += src_stride / 2;
266 }
267
268 return dist;
269 }
270
271 static void do_block_matching_multi(BM3DContext *s, const uint8_t *src, int src_stride, int src_range,
272 const PosCode *search_pos, int search_size, float th_mse,
273 int r_y, int r_x, int plane, int jobnr)
274 {
275 SliceContext *sc = &s->slices[jobnr];
276 double MSE2SSE = s->group_size * s->block_size * s->block_size * src_range * src_range / (s->max * s->max);
277 double distMul = 1. / MSE2SSE;
278 double th_sse = th_mse * MSE2SSE;
279 int index = sc->nb_match_blocks;
280
281 for (int i = 0; i < search_size; i++) {
282 PosCode pos = search_pos[i];
283 double dist;
284
285 dist = s->do_block_ssd(s, &pos, src, src_stride, r_y, r_x);
286
287 // Only match similar blocks but not identical blocks
288 if (dist <= th_sse && dist != 0) {
289 const double score = dist * distMul;
290
291 if (index >= s->group_size && score >= sc->match_blocks[index - 1].score) {
292 continue;
293 }
294
295 if (index >= s->group_size)
296 index = s->group_size - 1;
297
298 sc->match_blocks[index].score = score;
299 sc->match_blocks[index].y = pos.y;
300 sc->match_blocks[index].x = pos.x;
301 index++;
302 qsort(sc->match_blocks, index, sizeof(PosPairCode), cmp_scores);
303 }
304 }
305
306 sc->nb_match_blocks = index;
307 }
308
309 static void block_matching_multi(BM3DContext *s, const uint8_t *ref, int ref_linesize, int y, int x,
310 int exclude_cur_pos, int plane, int jobnr)
311 {
312 SliceContext *sc = &s->slices[jobnr];
313 const int width = s->planewidth[plane];
314 const int height = s->planeheight[plane];
315 const int block_size = s->block_size;
316 const int step = s->bm_step;
317 const int range = s->bm_range / step * step;
318 int l = search_boundary(0, range, step, 0, y, x);
319 int r = search_boundary(width - block_size, range, step, 0, y, x);
320 int t = search_boundary(0, range, step, 1, y, x);
321 int b = search_boundary(height - block_size, range, step, 1, y, x);
322 int index = 0;
323
324 for (int j = t; j <= b; j += step) {
325 for (int i = l; i <= r; i += step) {
326 PosCode pos;
327
328 if (exclude_cur_pos > 0 && j == y && i == x) {
329 continue;
330 }
331
332 pos.y = j;
333 pos.x = i;
334 sc->search_positions[index++] = pos;
335 }
336 }
337
338 if (exclude_cur_pos == 1) {
339 sc->match_blocks[0].score = 0;
340 sc->match_blocks[0].y = y;
341 sc->match_blocks[0].x = x;
342 sc->nb_match_blocks = 1;
343 }
344
345 do_block_matching_multi(s, ref, ref_linesize, s->bm_range,
346 sc->search_positions, index, s->th_mse, y, x, plane, jobnr);
347 }
348
349 static void block_matching(BM3DContext *s, const uint8_t *ref, int ref_linesize,
350 int j, int i, int plane, int jobnr)
351 {
352 SliceContext *sc = &s->slices[jobnr];
353
354 if (s->group_size == 1 || s->th_mse <= 0.f) {
355 sc->match_blocks[0].score = 1;
356 sc->match_blocks[0].x = i;
357 sc->match_blocks[0].y = j;
358 sc->nb_match_blocks = 1;
359 return;
360 }
361
362 sc->nb_match_blocks = 0;
363 block_matching_multi(s, ref, ref_linesize, j, i, 1, plane, jobnr);
364 }
365
366 static void get_block_row(const uint8_t *srcp, int src_linesize,
367 int y, int x, int block_size, float *dst)
368 {
369 const uint8_t *src = srcp + y * src_linesize + x;
370
371 for (int j = 0; j < block_size; j++)
372 dst[j] = src[j];
373 }
374
375 static void get_block_row16(const uint8_t *srcp, int src_linesize,
376 int y, int x, int block_size, float *dst)
377 {
378 const uint16_t *src = (uint16_t *)srcp + y * src_linesize / 2 + x;
379
380 for (int j = 0; j < block_size; j++)
381 dst[j] = src[j];
382 }
383
384 static void basic_block_filtering(BM3DContext *s, const uint8_t *src, int src_linesize,
385 const uint8_t *ref, int ref_linesize,
386 int y, int x, int plane, int jobnr)
387 {
388 SliceContext *sc = &s->slices[jobnr];
389 const int pblock_size = s->pblock_size;
390 const int buffer_linesize = s->pblock_size * s->pblock_size;
391 const int nb_match_blocks = sc->nb_match_blocks;
392 const int block_size = s->block_size;
393 const int width = s->planewidth[plane];
394 const int pgroup_size = s->pgroup_size;
395 const int group_size = s->group_size;
396 float *buffer = sc->buffer;
397 float *bufferh = sc->bufferh;
398 float *buffert = sc->buffert;
399 float *bufferv = sc->bufferv;
400 float *bufferz = sc->bufferz;
401 float threshold[4];
402 float den_weight, num_weight;
403 int retained = 0;
404
405 for (int k = 0; k < nb_match_blocks; k++) {
406 const int y = sc->match_blocks[k].y;
407 const int x = sc->match_blocks[k].x;
408
409 for (int i = 0; i < block_size; i++) {
410 s->get_block_row(src, src_linesize, y + i, x, block_size, bufferh + pblock_size * i);
411 sc->tx_fn(sc->dctf, buffert, bufferh + pblock_size * i, sizeof(float));
412 for (int j = 0; j < block_size; j++)
413 bufferv[j * pblock_size + i] = buffert[j];
414 }
415
416 for (int i = 0; i < block_size; i++) {
417 sc->tx_fn(sc->dctf, buffert, bufferv + i * pblock_size, sizeof(float));
418 memcpy(buffer + k * buffer_linesize + i * pblock_size,
419 buffert, block_size * sizeof(float));
420 }
421 }
422
423 for (int i = 0; i < block_size; i++) {
424 for (int j = 0; j < block_size; j++) {
425 for (int k = 0; k < nb_match_blocks; k++)
426 bufferz[k] = buffer[buffer_linesize * k + i * pblock_size + j];
427 if (group_size > 1)
428 sc->tx_fn_g(sc->gdctf, bufferz, bufferz, sizeof(float));
429 bufferz += pgroup_size;
430 }
431 }
432
433 threshold[0] = s->hard_threshold * s->sigma * M_SQRT2 * 4.f * block_size * block_size * (1 << (s->depth - 8)) / 255.f;
434 threshold[1] = threshold[0] * sqrtf(2.f);
435 threshold[2] = threshold[0] * 2.f;
436 threshold[3] = threshold[0] * sqrtf(8.f);
437 bufferz = sc->bufferz;
438
439 for (int i = 0; i < block_size; i++) {
440 for (int j = 0; j < block_size; j++) {
441 for (int k = 0; k < nb_match_blocks; k++) {
442 const float thresh = threshold[(j == 0) + (i == 0) + (k == 0)];
443
444 if (bufferz[k] > thresh || bufferz[k] < -thresh) {
445 retained++;
446 } else {
447 bufferz[k] = 0;
448 }
449 }
450 bufferz += pgroup_size;
451 }
452 }
453
454 bufferz = sc->bufferz;
455 buffer = sc->buffer;
456 for (int i = 0; i < block_size; i++) {
457 for (int j = 0; j < block_size; j++) {
458 if (group_size > 1)
459 sc->itx_fn_g(sc->gdcti, bufferz, bufferz, sizeof(float));
460 for (int k = 0; k < nb_match_blocks; k++)
461 buffer[buffer_linesize * k + i * pblock_size + j] = bufferz[k];
462 bufferz += pgroup_size;
463 }
464 }
465
466 den_weight = retained < 1 ? 1.f : 1.f / retained;
467 num_weight = den_weight;
468
469 buffer = sc->buffer;
470 for (int k = 0; k < nb_match_blocks; k++) {
471 float *num = sc->num + y * width + x;
472 float *den = sc->den + y * width + x;
473
474 for (int i = 0; i < block_size; i++) {
475 memcpy(bufferv + i * pblock_size,
476 buffer + k * buffer_linesize + i * pblock_size,
477 block_size * sizeof(float));
478 }
479
480 for (int i = 0; i < block_size; i++) {
481 sc->itx_fn(sc->dcti, buffert, bufferv + i * pblock_size, sizeof(float));
482 for (int j = 0; j < block_size; j++)
483 bufferh[j * pblock_size + i] = buffert[j];
484 }
485
486 for (int i = 0; i < block_size; i++) {
487 sc->itx_fn(sc->dcti, buffert, bufferh + pblock_size * i, sizeof(float));
488 for (int j = 0; j < block_size; j++) {
489 num[j] += buffert[j] * num_weight;
490 den[j] += den_weight;
491 }
492 num += width;
493 den += width;
494 }
495 }
496 }
497
498 static void final_block_filtering(BM3DContext *s, const uint8_t *src, int src_linesize,
499 const uint8_t *ref, int ref_linesize,
500 int y, int x, int plane, int jobnr)
501 {
502 SliceContext *sc = &s->slices[jobnr];
503 const int pblock_size = s->pblock_size;
504 const int buffer_linesize = s->pblock_size * s->pblock_size;
505 const int nb_match_blocks = sc->nb_match_blocks;
506 const int block_size = s->block_size;
507 const int width = s->planewidth[plane];
508 const int pgroup_size = s->pgroup_size;
509 const int group_size = s->group_size;
510 const float sigma_sqr = s->sigma * s->sigma;
511 float *buffer = sc->buffer;
512 float *bufferh = sc->bufferh;
513 float *bufferv = sc->bufferv;
514 float *bufferz = sc->bufferz;
515 float *rbuffer = sc->rbuffer;
516 float *rbufferh = sc->rbufferh;
517 float *rbufferv = sc->rbufferv;
518 float *rbufferz = sc->rbufferz;
519 float den_weight, num_weight;
520 float l2_wiener = 0;
521
522 for (int k = 0; k < nb_match_blocks; k++) {
523 const int y = sc->match_blocks[k].y;
524 const int x = sc->match_blocks[k].x;
525
526 for (int i = 0; i < block_size; i++) {
527 s->get_block_row(src, src_linesize, y + i, x, block_size, bufferh + pblock_size * i);
528 s->get_block_row(ref, ref_linesize, y + i, x, block_size, rbufferh + pblock_size * i);
529 sc->tx_fn(sc->dctf, bufferh + pblock_size * i, bufferh + pblock_size * i, sizeof(float));
530 sc->tx_fn(sc->dctf, rbufferh + pblock_size * i, rbufferh + pblock_size * i, sizeof(float));
531 }
532
533 for (int i = 0; i < block_size; i++) {
534 for (int j = 0; j < block_size; j++) {
535 bufferv[i * pblock_size + j] = bufferh[j * pblock_size + i];
536 rbufferv[i * pblock_size + j] = rbufferh[j * pblock_size + i];
537 }
538 sc->tx_fn(sc->dctf, bufferv + i * pblock_size, bufferv + i * pblock_size, sizeof(float));
539 sc->tx_fn(sc->dctf, rbufferv + i * pblock_size, rbufferv + i * pblock_size, sizeof(float));
540 }
541
542 for (int i = 0; i < block_size; i++) {
543 memcpy(buffer + k * buffer_linesize + i * pblock_size,
544 bufferv + i * pblock_size, block_size * sizeof(float));
545 memcpy(rbuffer + k * buffer_linesize + i * pblock_size,
546 rbufferv + i * pblock_size, block_size * sizeof(float));
547 }
548 }
549
550 for (int i = 0; i < block_size; i++) {
551 for (int j = 0; j < block_size; j++) {
552 for (int k = 0; k < nb_match_blocks; k++) {
553 bufferz[k] = buffer[buffer_linesize * k + i * pblock_size + j];
554 rbufferz[k] = rbuffer[buffer_linesize * k + i * pblock_size + j];
555 }
556 if (group_size > 1) {
557 sc->tx_fn_g(sc->gdctf, bufferz, bufferz, sizeof(float));
558 sc->tx_fn_g(sc->gdctf, rbufferz, rbufferz, sizeof(float));
559 }
560 bufferz += pgroup_size;
561 rbufferz += pgroup_size;
562 }
563 }
564
565 bufferz = sc->bufferz;
566 rbufferz = sc->rbufferz;
567
568 for (int i = 0; i < block_size; i++) {
569 for (int j = 0; j < block_size; j++) {
570 for (int k = 0; k < nb_match_blocks; k++) {
571 const float ref_sqr = rbufferz[k] * rbufferz[k];
572 float wiener_coef = ref_sqr / (ref_sqr + sigma_sqr);
573
574 if (isnan(wiener_coef))
575 wiener_coef = 1;
576 bufferz[k] *= wiener_coef;
577 l2_wiener += wiener_coef * wiener_coef;
578 }
579 bufferz += pgroup_size;
580 rbufferz += pgroup_size;
581 }
582 }
583
584 bufferz = sc->bufferz;
585 buffer = sc->buffer;
586 for (int i = 0; i < block_size; i++) {
587 for (int j = 0; j < block_size; j++) {
588 if (group_size > 1)
589 sc->itx_fn_g(sc->gdcti, bufferz, bufferz, sizeof(float));
590 for (int k = 0; k < nb_match_blocks; k++) {
591 buffer[buffer_linesize * k + i * pblock_size + j] = bufferz[k];
592 }
593 bufferz += pgroup_size;
594 }
595 }
596
597 l2_wiener = FFMAX(l2_wiener, 1e-15f);
598 den_weight = 1.f / l2_wiener;
599 num_weight = den_weight;
600
601 for (int k = 0; k < nb_match_blocks; k++) {
602 float *num = sc->num + y * width + x;
603 float *den = sc->den + y * width + x;
604
605 for (int i = 0; i < block_size; i++) {
606 memcpy(bufferv + i * pblock_size,
607 buffer + k * buffer_linesize + i * pblock_size,
608 block_size * sizeof(float));
609 }
610
611 for (int i = 0; i < block_size; i++) {
612 sc->itx_fn(sc->dcti, bufferv + pblock_size * i, bufferv + pblock_size * i, sizeof(float));
613 for (int j = 0; j < block_size; j++) {
614 bufferh[j * pblock_size + i] = bufferv[i * pblock_size + j];
615 }
616 }
617
618 for (int i = 0; i < block_size; i++) {
619 sc->itx_fn(sc->dcti, bufferh + pblock_size * i, bufferh + pblock_size * i, sizeof(float));
620 for (int j = 0; j < block_size; j++) {
621 num[j] += bufferh[i * pblock_size + j] * num_weight;
622 den[j] += den_weight;
623 }
624 num += width;
625 den += width;
626 }
627 }
628 }
629
630 static void do_output(BM3DContext *s, uint8_t *dst, int dst_linesize,
631 int plane, int nb_jobs)
632 {
633 const int height = s->planeheight[plane];
634 const int width = s->planewidth[plane];
635
636 for (int i = 0; i < height; i++) {
637 for (int j = 0; j < width; j++) {
638 uint8_t *dstp = dst + i * dst_linesize;
639 float sum_den = 0.f;
640 float sum_num = 0.f;
641
642 for (int k = 0; k < nb_jobs; k++) {
643 SliceContext *sc = &s->slices[k];
644 float num = sc->num[i * width + j];
645 float den = sc->den[i * width + j];
646
647 sum_num += num;
648 sum_den += den;
649 }
650
651 dstp[j] = av_clip_uint8(lrintf(sum_num / sum_den));
652 }
653 }
654 }
655
656 static void do_output16(BM3DContext *s, uint8_t *dst, int dst_linesize,
657 int plane, int nb_jobs)
658 {
659 const int height = s->planeheight[plane];
660 const int width = s->planewidth[plane];
661 const int depth = s->depth;
662
663 for (int i = 0; i < height; i++) {
664 for (int j = 0; j < width; j++) {
665 uint16_t *dstp = (uint16_t *)dst + i * dst_linesize / 2;
666 float sum_den = 0.f;
667 float sum_num = 0.f;
668
669 for (int k = 0; k < nb_jobs; k++) {
670 SliceContext *sc = &s->slices[k];
671 float num = sc->num[i * width + j];
672 float den = sc->den[i * width + j];
673
674 sum_num += num;
675 sum_den += den;
676 }
677
678 dstp[j] = av_clip_uintp2_c(lrintf(sum_num / sum_den), depth);
679 }
680 }
681 }
682
683 static int filter_slice(AVFilterContext *ctx, void *arg, int jobnr, int nb_jobs)
684 {
685 BM3DContext *s = ctx->priv;
686 SliceContext *sc = &s->slices[jobnr];
687 const int block_step = s->block_step;
688 ThreadData *td = arg;
689 const uint8_t *src = td->src;
690 const uint8_t *ref = td->ref;
691 const int src_linesize = td->src_linesize;
692 const int ref_linesize = td->ref_linesize;
693 const int plane = td->plane;
694 const int width = s->planewidth[plane];
695 const int height = s->planeheight[plane];
696 const int block_pos_bottom = FFMAX(0, height - s->block_size);
697 const int block_pos_right = FFMAX(0, width - s->block_size);
698 const int slice_start = (((height + block_step - 1) / block_step) * jobnr / nb_jobs) * block_step;
699 const int slice_end = (jobnr == nb_jobs - 1) ? block_pos_bottom + block_step :
700 (((height + block_step - 1) / block_step) * (jobnr + 1) / nb_jobs) * block_step;
701
702 memset(sc->num, 0, width * height * sizeof(float));
703 memset(sc->den, 0, width * height * sizeof(float));
704
705 for (int j = slice_start; j < slice_end; j += block_step) {
706 if (j > block_pos_bottom) {
707 j = block_pos_bottom;
708 }
709
710 for (int i = 0; i < block_pos_right + block_step; i += block_step) {
711 if (i > block_pos_right) {
712 i = block_pos_right;
713 }
714
715 block_matching(s, ref, ref_linesize, j, i, plane, jobnr);
716
717 s->block_filtering(s, src, src_linesize,
718 ref, ref_linesize, j, i, plane, jobnr);
719 }
720 }
721
722 return 0;
723 }
724
725 static int filter_frame(AVFilterContext *ctx, AVFrame **out, AVFrame *in, AVFrame *ref)
726 {
727 BM3DContext *s = ctx->priv;
728 AVFilterLink *outlink = ctx->outputs[0];
729 int p;
730
731 *out = ff_get_video_buffer(outlink, outlink->w, outlink->h);
732 if (!*out)
733 return AVERROR(ENOMEM);
734 av_frame_copy_props(*out, in);
735
736 for (p = 0; p < s->nb_planes; p++) {
737 const int nb_jobs = FFMAX(1, FFMIN(s->nb_threads, s->planeheight[p] / s->block_size));
738 ThreadData td;
739
740 if (!((1 << p) & s->planes) || ctx->is_disabled) {
741 av_image_copy_plane((*out)->data[p], (*out)->linesize[p],
742 in->data[p], in->linesize[p],
743 s->planewidth[p] * (1 + (s->depth > 8)), s->planeheight[p]);
744 continue;
745 }
746
747 td.src = in->data[p];
748 td.src_linesize = in->linesize[p];
749 td.ref = ref->data[p];
750 td.ref_linesize = ref->linesize[p];
751 td.plane = p;
752 ff_filter_execute(ctx, filter_slice, &td, NULL, nb_jobs);
753
754 s->do_output(s, (*out)->data[p], (*out)->linesize[p], p, nb_jobs);
755 }
756
757 return 0;
758 }
759
760 #define SQR(x) ((x) * (x))
761
762 static int config_input(AVFilterLink *inlink)
763 {
764 const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(inlink->format);
765 AVFilterContext *ctx = inlink->dst;
766 BM3DContext *s = ctx->priv;
767
768 s->nb_threads = FFMIN(ff_filter_get_nb_threads(ctx), MAX_NB_THREADS);
769 s->nb_planes = av_pix_fmt_count_planes(inlink->format);
770 s->depth = desc->comp[0].depth;
771 s->max = (1 << s->depth) - 1;
772 s->planeheight[1] = s->planeheight[2] = AV_CEIL_RSHIFT(inlink->h, desc->log2_chroma_h);
773 s->planeheight[0] = s->planeheight[3] = inlink->h;
774 s->planewidth[1] = s->planewidth[2] = AV_CEIL_RSHIFT(inlink->w, desc->log2_chroma_w);
775 s->planewidth[0] = s->planewidth[3] = inlink->w;
776 s->pblock_size = FFALIGN(s->block_size * 2, av_cpu_max_align());
777 s->pgroup_size = FFALIGN(s->group_size * 2, av_cpu_max_align());
778
779 for (int i = 0; i < s->nb_threads; i++) {
780 SliceContext *sc = &s->slices[i];
781 float iscale = 0.5f / s->block_size;
782 float scale = 1.f;
783 int ret;
784
785 sc->num = av_calloc(FFALIGN(s->planewidth[0], s->block_size) * FFALIGN(s->planeheight[0], s->block_size), sizeof(float));
786 sc->den = av_calloc(FFALIGN(s->planewidth[0], s->block_size) * FFALIGN(s->planeheight[0], s->block_size), sizeof(float));
787 if (!sc->num || !sc->den)
788 return AVERROR(ENOMEM);
789
790 ret = av_tx_init(&sc->dctf, &sc->tx_fn, AV_TX_FLOAT_DCT, 0, s->block_size >> 0, &scale, 0);
791 if (ret < 0)
792 return ret;
793
794 ret = av_tx_init(&sc->dcti, &sc->itx_fn, AV_TX_FLOAT_DCT, 1, s->block_size >> 1, &iscale, 0);
795 if (ret < 0)
796 return ret;
797
798 if (s->group_size > 1) {
799 float iscale = 0.5f / s->group_size;
800
801 ret = av_tx_init(&sc->gdctf, &sc->tx_fn_g, AV_TX_FLOAT_DCT, 0, s->group_size >> 0, &scale, 0);
802 if (ret < 0)
803 return ret;
804
805 ret = av_tx_init(&sc->gdcti, &sc->itx_fn_g, AV_TX_FLOAT_DCT, 1, s->group_size >> 1, &iscale, 0);
806 if (ret < 0)
807 return ret;
808 }
809
810 sc->buffer = av_calloc(s->pblock_size * s->pblock_size * s->pgroup_size, sizeof(*sc->buffer));
811 sc->bufferz = av_calloc(s->pblock_size * s->pblock_size * s->pgroup_size, sizeof(*sc->bufferz));
812 sc->bufferh = av_calloc(s->pblock_size * s->pblock_size, sizeof(*sc->bufferh));
813 sc->bufferv = av_calloc(s->pblock_size * s->pblock_size, sizeof(*sc->bufferv));
814 sc->buffert = av_calloc(s->pblock_size, sizeof(*sc->buffert));
815 if (!sc->bufferh || !sc->bufferv || !sc->buffer || !sc->bufferz || !sc->buffert)
816 return AVERROR(ENOMEM);
817
818 if (s->mode == FINAL) {
819 sc->rbuffer = av_calloc(s->pblock_size * s->pblock_size * s->pgroup_size, sizeof(*sc->rbuffer));
820 sc->rbufferz = av_calloc(s->pblock_size * s->pblock_size * s->pgroup_size, sizeof(*sc->rbufferz));
821 sc->rbufferh = av_calloc(s->pblock_size * s->pblock_size, sizeof(*sc->rbufferh));
822 sc->rbufferv = av_calloc(s->pblock_size * s->pblock_size, sizeof(*sc->rbufferv));
823 if (!sc->rbufferh || !sc->rbufferv || !sc->rbuffer || !sc->rbufferz)
824 return AVERROR(ENOMEM);
825 }
826
827 sc->search_positions = av_calloc(SQR(2 * s->bm_range / s->bm_step + 1), sizeof(*sc->search_positions));
828 if (!sc->search_positions)
829 return AVERROR(ENOMEM);
830 }
831
832 s->do_output = do_output;
833 s->do_block_ssd = do_block_ssd;
834 s->get_block_row = get_block_row;
835
836 if (s->depth > 8) {
837 s->do_output = do_output16;
838 s->do_block_ssd = do_block_ssd16;
839 s->get_block_row = get_block_row16;
840 }
841
842 return 0;
843 }
844
845 static int activate(AVFilterContext *ctx)
846 {
847 BM3DContext *s = ctx->priv;
848
849 if (!s->ref) {
850 AVFrame *frame = NULL;
851 AVFrame *out = NULL;
852 int ret, status;
853 int64_t pts;
854
855 FF_FILTER_FORWARD_STATUS_BACK(ctx->outputs[0], ctx->inputs[0]);
856
857 if ((ret = ff_inlink_consume_frame(ctx->inputs[0], &frame)) > 0) {
858 ret = filter_frame(ctx, &out, frame, frame);
859 av_frame_free(&frame);
860 if (ret < 0)
861 return ret;
862 ret = ff_filter_frame(ctx->outputs[0], out);
863 }
864 if (ret < 0) {
865 return ret;
866 } else if (ff_inlink_acknowledge_status(ctx->inputs[0], &status, &pts)) {
867 ff_outlink_set_status(ctx->outputs[0], status, pts);
868 return 0;
869 } else {
870 if (ff_outlink_frame_wanted(ctx->outputs[0]))
871 ff_inlink_request_frame(ctx->inputs[0]);
872 return 0;
873 }
874 } else {
875 return ff_framesync_activate(&s->fs);
876 }
877 }
878
879 static int process_frame(FFFrameSync *fs)
880 {
881 AVFilterContext *ctx = fs->parent;
882 BM3DContext *s = fs->opaque;
883 AVFilterLink *outlink = ctx->outputs[0];
884 AVFrame *out = NULL, *src, *ref;
885 int ret;
886
887 if ((ret = ff_framesync_get_frame(&s->fs, 0, &src, 0)) < 0 ||
888 (ret = ff_framesync_get_frame(&s->fs, 1, &ref, 0)) < 0)
889 return ret;
890
891 if ((ret = filter_frame(ctx, &out, src, ref)) < 0)
892 return ret;
893
894 out->pts = av_rescale_q(src->pts, s->fs.time_base, outlink->time_base);
895
896 return ff_filter_frame(outlink, out);
897 }
898
899 static av_cold int init(AVFilterContext *ctx)
900 {
901 BM3DContext *s = ctx->priv;
902 AVFilterPad pad = { 0 };
903 int ret;
904
905 if (s->mode == BASIC) {
906 if (s->th_mse == 0.f)
907 s->th_mse = 400.f + s->sigma * 80.f;
908 s->block_filtering = basic_block_filtering;
909 } else if (s->mode == FINAL) {
910 if (!s->ref) {
911 av_log(ctx, AV_LOG_WARNING, "Reference stream is mandatory in final estimation mode.\n");
912 s->ref = 1;
913 }
914 if (s->th_mse == 0.f)
915 s->th_mse = 200.f + s->sigma * 10.f;
916
917 s->block_filtering = final_block_filtering;
918 } else {
919 return AVERROR_BUG;
920 }
921
922 if (s->block_step > s->block_size) {
923 av_log(ctx, AV_LOG_WARNING, "bstep: %d can't be bigger than block size. Changing to %d.\n",
924 s->block_step, s->block_size);
925 s->block_step = s->block_size;
926 }
927
928 if (s->bm_step > s->bm_range) {
929 av_log(ctx, AV_LOG_WARNING, "mstep: %d can't be bigger than block matching range. Changing to %d.\n",
930 s->bm_step, s->bm_range);
931 s->bm_step = s->bm_range;
932 }
933
934 pad.type = AVMEDIA_TYPE_VIDEO;
935 pad.name = "source";
936 pad.config_props = config_input;
937
938 if ((ret = ff_append_inpad(ctx, &pad)) < 0)
939 return ret;
940
941 if (s->ref) {
942 pad.type = AVMEDIA_TYPE_VIDEO;
943 pad.name = "reference";
944 pad.config_props = NULL;
945
946 if ((ret = ff_append_inpad(ctx, &pad)) < 0)
947 return ret;
948 }
949
950 return 0;
951 }
952
953 static int config_output(AVFilterLink *outlink)
954 {
955 AVFilterContext *ctx = outlink->src;
956 BM3DContext *s = ctx->priv;
957 AVFilterLink *src = ctx->inputs[0];
958 AVFilterLink *ref;
959 FFFrameSyncIn *in;
960 int ret;
961
962 if (s->ref) {
963 ref = ctx->inputs[1];
964
965 if (src->w != ref->w ||
966 src->h != ref->h) {
967 av_log(ctx, AV_LOG_ERROR, "First input link %s parameters "
968 "(size %dx%d) do not match the corresponding "
969 "second input link %s parameters (%dx%d) ",
970 ctx->input_pads[0].name, src->w, src->h,
971 ctx->input_pads[1].name, ref->w, ref->h);
972 return AVERROR(EINVAL);
973 }
974 }
975
976 outlink->w = src->w;
977 outlink->h = src->h;
978 outlink->time_base = src->time_base;
979 outlink->sample_aspect_ratio = src->sample_aspect_ratio;
980 outlink->frame_rate = src->frame_rate;
981
982 if (!s->ref)
983 return 0;
984
985 if ((ret = ff_framesync_init(&s->fs, ctx, 2)) < 0)
986 return ret;
987
988 in = s->fs.in;
989 in[0].time_base = src->time_base;
990 in[1].time_base = ref->time_base;
991 in[0].sync = 1;
992 in[0].before = EXT_STOP;
993 in[0].after = EXT_STOP;
994 in[1].sync = 1;
995 in[1].before = EXT_STOP;
996 in[1].after = EXT_STOP;
997 s->fs.opaque = s;
998 s->fs.on_event = process_frame;
999
1000 return ff_framesync_configure(&s->fs);
1001 }
1002
1003 static av_cold void uninit(AVFilterContext *ctx)
1004 {
1005 BM3DContext *s = ctx->priv;
1006
1007 if (s->ref)
1008 ff_framesync_uninit(&s->fs);
1009
1010 for (int i = 0; i < s->nb_threads; i++) {
1011 SliceContext *sc = &s->slices[i];
1012
1013 av_freep(&sc->num);
1014 av_freep(&sc->den);
1015
1016 av_tx_uninit(&sc->gdctf);
1017 av_tx_uninit(&sc->gdcti);
1018 av_tx_uninit(&sc->dctf);
1019 av_tx_uninit(&sc->dcti);
1020
1021 av_freep(&sc->buffer);
1022 av_freep(&sc->bufferh);
1023 av_freep(&sc->buffert);
1024 av_freep(&sc->bufferv);
1025 av_freep(&sc->bufferz);
1026 av_freep(&sc->rbuffer);
1027 av_freep(&sc->rbufferh);
1028 av_freep(&sc->rbufferv);
1029 av_freep(&sc->rbufferz);
1030
1031 av_freep(&sc->search_positions);
1032 }
1033 }
1034
1035 static const AVFilterPad bm3d_outputs[] = {
1036 {
1037 .name = "default",
1038 .type = AVMEDIA_TYPE_VIDEO,
1039 .config_props = config_output,
1040 },
1041 };
1042
1043 const AVFilter ff_vf_bm3d = {
1044 .name = "bm3d",
1045 .description = NULL_IF_CONFIG_SMALL("Block-Matching 3D denoiser."),
1046 .priv_size = sizeof(BM3DContext),
1047 .init = init,
1048 .uninit = uninit,
1049 .activate = activate,
1050 .inputs = NULL,
1051 FILTER_OUTPUTS(bm3d_outputs),
1052 FILTER_PIXFMTS_ARRAY(pix_fmts),
1053 .priv_class = &bm3d_class,
1054 .flags = AVFILTER_FLAG_SUPPORT_TIMELINE_INTERNAL |
1055 AVFILTER_FLAG_DYNAMIC_INPUTS |
1056 AVFILTER_FLAG_SLICE_THREADS,
1057 };
1058