diff options
Diffstat (limited to 'libavfilter/vf_noise.c')
-rw-r--r-- | libavfilter/vf_noise.c | 490 |
1 files changed, 490 insertions, 0 deletions
diff --git a/libavfilter/vf_noise.c b/libavfilter/vf_noise.c new file mode 100644 index 0000000..934cbcb --- /dev/null +++ b/libavfilter/vf_noise.c @@ -0,0 +1,490 @@ +/* + * Copyright (c) 2002 Michael Niedermayer <michaelni@gmx.at> + * Copyright (c) 2013 Paul B Mahol + * + * This file is part of FFmpeg. + * + * FFmpeg is free software; you can redistribute it and/or + * modify it under the terms of the GNU Lesser General Public + * License as published by the Free Software Foundation; either + * version 2.1 of the License, or (at your option) any later version. + * + * FFmpeg is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU + * Lesser General Public License for more details. + * + * You should have received a copy of the GNU Lesser General Public + * License along with FFmpeg; if not, write to the Free Software + * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA + */ + +/** + * @file + * noise generator + */ + +#include "libavutil/opt.h" +#include "libavutil/imgutils.h" +#include "libavutil/lfg.h" +#include "libavutil/parseutils.h" +#include "libavutil/pixdesc.h" +#include "libavutil/x86/asm.h" +#include "avfilter.h" +#include "formats.h" +#include "internal.h" +#include "video.h" + +#define MAX_NOISE 5120 +#define MAX_SHIFT 1024 +#define MAX_RES (MAX_NOISE-MAX_SHIFT) + +#define NOISE_UNIFORM 1 +#define NOISE_TEMPORAL 2 +#define NOISE_AVERAGED 8 +#define NOISE_PATTERN 16 + +typedef struct { + int strength; + unsigned flags; + AVLFG lfg; + int seed; + int8_t *noise; + int8_t *prev_shift[MAX_RES][3]; +} FilterParams; + +typedef struct { + const AVClass *class; + int nb_planes; + int bytewidth[4]; + int height[4]; + FilterParams all; + FilterParams param[4]; + int rand_shift[MAX_RES]; + int rand_shift_init; + void (*line_noise)(uint8_t *dst, const uint8_t *src, int8_t *noise, int len, int shift); + void (*line_noise_avg)(uint8_t *dst, const uint8_t *src, int len, int8_t **shift); +} NoiseContext; + +typedef struct ThreadData { + AVFrame *in, *out; +} ThreadData; + +#define OFFSET(x) offsetof(NoiseContext, x) +#define FLAGS AV_OPT_FLAG_FILTERING_PARAM|AV_OPT_FLAG_VIDEO_PARAM + +#define NOISE_PARAMS(name, x, param) \ + {#name"_seed", "set component #"#x" noise seed", OFFSET(param.seed), AV_OPT_TYPE_INT, {.i64=-1}, -1, INT_MAX, FLAGS}, \ + {#name"_strength", "set component #"#x" strength", OFFSET(param.strength), AV_OPT_TYPE_INT, {.i64=0}, 0, 100, FLAGS}, \ + {#name"s", "set component #"#x" strength", OFFSET(param.strength), AV_OPT_TYPE_INT, {.i64=0}, 0, 100, FLAGS}, \ + {#name"_flags", "set component #"#x" flags", OFFSET(param.flags), AV_OPT_TYPE_FLAGS, {.i64=0}, 0, 31, FLAGS, #name"_flags"}, \ + {#name"f", "set component #"#x" flags", OFFSET(param.flags), AV_OPT_TYPE_FLAGS, {.i64=0}, 0, 31, FLAGS, #name"_flags"}, \ + {"a", "averaged noise", 0, AV_OPT_TYPE_CONST, {.i64=NOISE_AVERAGED}, 0, 0, FLAGS, #name"_flags"}, \ + {"p", "(semi)regular pattern", 0, AV_OPT_TYPE_CONST, {.i64=NOISE_PATTERN}, 0, 0, FLAGS, #name"_flags"}, \ + {"t", "temporal noise", 0, AV_OPT_TYPE_CONST, {.i64=NOISE_TEMPORAL}, 0, 0, FLAGS, #name"_flags"}, \ + {"u", "uniform noise", 0, AV_OPT_TYPE_CONST, {.i64=NOISE_UNIFORM}, 0, 0, FLAGS, #name"_flags"}, + +static const AVOption noise_options[] = { + NOISE_PARAMS(all, 0, all) + NOISE_PARAMS(c0, 0, param[0]) + NOISE_PARAMS(c1, 1, param[1]) + NOISE_PARAMS(c2, 2, param[2]) + NOISE_PARAMS(c3, 3, param[3]) + {NULL} +}; + +AVFILTER_DEFINE_CLASS(noise); + +static const int8_t patt[4] = { -1, 0, 1, 0 }; + +#define RAND_N(range) ((int) ((double) range * av_lfg_get(lfg) / (UINT_MAX + 1.0))) +static av_cold int init_noise(NoiseContext *n, int comp) +{ + int8_t *noise = av_malloc(MAX_NOISE * sizeof(int8_t)); + FilterParams *fp = &n->param[comp]; + AVLFG *lfg = &n->param[comp].lfg; + int strength = fp->strength; + int flags = fp->flags; + int i, j; + + if (!noise) + return AVERROR(ENOMEM); + + av_lfg_init(&fp->lfg, fp->seed); + + for (i = 0, j = 0; i < MAX_NOISE; i++, j++) { + if (flags & NOISE_UNIFORM) { + if (flags & NOISE_AVERAGED) { + if (flags & NOISE_PATTERN) { + noise[i] = (RAND_N(strength) - strength / 2) / 6 + + patt[j % 4] * strength * 0.25 / 3; + } else { + noise[i] = (RAND_N(strength) - strength / 2) / 3; + } + } else { + if (flags & NOISE_PATTERN) { + noise[i] = (RAND_N(strength) - strength / 2) / 2 + + patt[j % 4] * strength * 0.25; + } else { + noise[i] = RAND_N(strength) - strength / 2; + } + } + } else { + double x1, x2, w, y1; + do { + x1 = 2.0 * av_lfg_get(lfg) / (float)UINT_MAX - 1.0; + x2 = 2.0 * av_lfg_get(lfg) / (float)UINT_MAX - 1.0; + w = x1 * x1 + x2 * x2; + } while (w >= 1.0); + + w = sqrt((-2.0 * log(w)) / w); + y1 = x1 * w; + y1 *= strength / sqrt(3.0); + if (flags & NOISE_PATTERN) { + y1 /= 2; + y1 += patt[j % 4] * strength * 0.35; + } + y1 = av_clipf(y1, -128, 127); + if (flags & NOISE_AVERAGED) + y1 /= 3.0; + noise[i] = (int)y1; + } + if (RAND_N(6) == 0) + j--; + } + + for (i = 0; i < MAX_RES; i++) + for (j = 0; j < 3; j++) + fp->prev_shift[i][j] = noise + (av_lfg_get(lfg) & (MAX_SHIFT - 1)); + + if (!n->rand_shift_init) { + for (i = 0; i < MAX_RES; i++) + n->rand_shift[i] = av_lfg_get(lfg) & (MAX_SHIFT - 1); + n->rand_shift_init = 1; + } + + fp->noise = noise; + return 0; +} + +static int query_formats(AVFilterContext *ctx) +{ + AVFilterFormats *formats = NULL; + int fmt; + + for (fmt = 0; av_pix_fmt_desc_get(fmt); fmt++) { + const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(fmt); + if (desc->flags & AV_PIX_FMT_FLAG_PLANAR && !((desc->comp[0].depth_minus1 + 1) & 7)) + ff_add_format(&formats, fmt); + } + + ff_set_common_formats(ctx, formats); + return 0; +} + +static int config_input(AVFilterLink *inlink) +{ + NoiseContext *n = inlink->dst->priv; + const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(inlink->format); + int ret; + + n->nb_planes = av_pix_fmt_count_planes(inlink->format); + + if ((ret = av_image_fill_linesizes(n->bytewidth, inlink->format, inlink->w)) < 0) + return ret; + + n->height[1] = n->height[2] = FF_CEIL_RSHIFT(inlink->h, desc->log2_chroma_h); + n->height[0] = n->height[3] = inlink->h; + + return 0; +} + +static inline void line_noise_c(uint8_t *dst, const uint8_t *src, int8_t *noise, + int len, int shift) +{ + int i; + + noise += shift; + for (i = 0; i < len; i++) { + int v = src[i] + noise[i]; + + dst[i] = av_clip_uint8(v); + } +} + +#define ASMALIGN(ZEROBITS) ".p2align " #ZEROBITS "\n\t" + +static void line_noise_mmx(uint8_t *dst, const uint8_t *src, + int8_t *noise, int len, int shift) +{ +#if HAVE_MMX_INLINE + x86_reg mmx_len= len&(~7); + noise+=shift; + + __asm__ volatile( + "mov %3, %%"REG_a" \n\t" + "pcmpeqb %%mm7, %%mm7 \n\t" + "psllw $15, %%mm7 \n\t" + "packsswb %%mm7, %%mm7 \n\t" + ASMALIGN(4) + "1: \n\t" + "movq (%0, %%"REG_a"), %%mm0 \n\t" + "movq (%1, %%"REG_a"), %%mm1 \n\t" + "pxor %%mm7, %%mm0 \n\t" + "paddsb %%mm1, %%mm0 \n\t" + "pxor %%mm7, %%mm0 \n\t" + "movq %%mm0, (%2, %%"REG_a") \n\t" + "add $8, %%"REG_a" \n\t" + " js 1b \n\t" + :: "r" (src+mmx_len), "r" (noise+mmx_len), "r" (dst+mmx_len), "g" (-mmx_len) + : "%"REG_a + ); + if (mmx_len!=len) + line_noise_c(dst+mmx_len, src+mmx_len, noise+mmx_len, len-mmx_len, 0); +#endif +} + +static void line_noise_mmxext(uint8_t *dst, const uint8_t *src, + int8_t *noise, int len, int shift) +{ +#if HAVE_MMXEXT_INLINE + x86_reg mmx_len= len&(~7); + noise+=shift; + + __asm__ volatile( + "mov %3, %%"REG_a" \n\t" + "pcmpeqb %%mm7, %%mm7 \n\t" + "psllw $15, %%mm7 \n\t" + "packsswb %%mm7, %%mm7 \n\t" + ASMALIGN(4) + "1: \n\t" + "movq (%0, %%"REG_a"), %%mm0 \n\t" + "movq (%1, %%"REG_a"), %%mm1 \n\t" + "pxor %%mm7, %%mm0 \n\t" + "paddsb %%mm1, %%mm0 \n\t" + "pxor %%mm7, %%mm0 \n\t" + "movntq %%mm0, (%2, %%"REG_a") \n\t" + "add $8, %%"REG_a" \n\t" + " js 1b \n\t" + :: "r" (src+mmx_len), "r" (noise+mmx_len), "r" (dst+mmx_len), "g" (-mmx_len) + : "%"REG_a + ); + if (mmx_len != len) + line_noise_c(dst+mmx_len, src+mmx_len, noise+mmx_len, len-mmx_len, 0); +#endif +} + +static inline void line_noise_avg_c(uint8_t *dst, const uint8_t *src, + int len, int8_t **shift) +{ + int i; + int8_t *src2 = (int8_t*)src; + + for (i = 0; i < len; i++) { + const int n = shift[0][i] + shift[1][i] + shift[2][i]; + dst[i] = src2[i] + ((n * src2[i]) >> 7); + } +} + +static inline void line_noise_avg_mmx(uint8_t *dst, const uint8_t *src, + int len, int8_t **shift) +{ +#if HAVE_MMX_INLINE && HAVE_6REGS + x86_reg mmx_len= len&(~7); + + __asm__ volatile( + "mov %5, %%"REG_a" \n\t" + ASMALIGN(4) + "1: \n\t" + "movq (%1, %%"REG_a"), %%mm1 \n\t" + "movq (%0, %%"REG_a"), %%mm0 \n\t" + "paddb (%2, %%"REG_a"), %%mm1 \n\t" + "paddb (%3, %%"REG_a"), %%mm1 \n\t" + "movq %%mm0, %%mm2 \n\t" + "movq %%mm1, %%mm3 \n\t" + "punpcklbw %%mm0, %%mm0 \n\t" + "punpckhbw %%mm2, %%mm2 \n\t" + "punpcklbw %%mm1, %%mm1 \n\t" + "punpckhbw %%mm3, %%mm3 \n\t" + "pmulhw %%mm0, %%mm1 \n\t" + "pmulhw %%mm2, %%mm3 \n\t" + "paddw %%mm1, %%mm1 \n\t" + "paddw %%mm3, %%mm3 \n\t" + "paddw %%mm0, %%mm1 \n\t" + "paddw %%mm2, %%mm3 \n\t" + "psrlw $8, %%mm1 \n\t" + "psrlw $8, %%mm3 \n\t" + "packuswb %%mm3, %%mm1 \n\t" + "movq %%mm1, (%4, %%"REG_a") \n\t" + "add $8, %%"REG_a" \n\t" + " js 1b \n\t" + :: "r" (src+mmx_len), "r" (shift[0]+mmx_len), "r" (shift[1]+mmx_len), "r" (shift[2]+mmx_len), + "r" (dst+mmx_len), "g" (-mmx_len) + : "%"REG_a + ); + + if (mmx_len != len){ + int8_t *shift2[3]={shift[0]+mmx_len, shift[1]+mmx_len, shift[2]+mmx_len}; + line_noise_avg_c(dst+mmx_len, src+mmx_len, len-mmx_len, shift2); + } +#endif +} + +static void noise(uint8_t *dst, const uint8_t *src, + int dst_linesize, int src_linesize, + int width, int start, int end, NoiseContext *n, int comp) +{ + FilterParams *p = &n->param[comp]; + int8_t *noise = p->noise; + const int flags = p->flags; + AVLFG *lfg = &p->lfg; + int shift, y; + + if (!noise) { + if (dst != src) + av_image_copy_plane(dst, dst_linesize, src, src_linesize, width, end - start); + return; + } + + for (y = start; y < end; y++) { + const int ix = y & (MAX_RES - 1); + if (flags & NOISE_TEMPORAL) + shift = av_lfg_get(lfg) & (MAX_SHIFT - 1); + else + shift = n->rand_shift[ix]; + + if (flags & NOISE_AVERAGED) { + n->line_noise_avg(dst, src, width, p->prev_shift[ix]); + p->prev_shift[ix][shift & 3] = noise + shift; + } else { + n->line_noise(dst, src, noise, width, shift); + } + dst += dst_linesize; + src += src_linesize; + } +} + +static int filter_slice(AVFilterContext *ctx, void *arg, int jobnr, int nb_jobs) +{ + NoiseContext *s = ctx->priv; + ThreadData *td = arg; + int plane; + + for (plane = 0; plane < s->nb_planes; plane++) { + const int height = s->height[plane]; + const int start = (height * jobnr ) / nb_jobs; + const int end = (height * (jobnr+1)) / nb_jobs; + noise(td->out->data[plane] + start * td->out->linesize[plane], + td->in->data[plane] + start * td->in->linesize[plane], + td->out->linesize[plane], td->in->linesize[plane], + s->bytewidth[plane], start, end, s, plane); + } + return 0; +} + +static int filter_frame(AVFilterLink *inlink, AVFrame *inpicref) +{ + AVFilterContext *ctx = inlink->dst; + AVFilterLink *outlink = ctx->outputs[0]; + NoiseContext *n = ctx->priv; + ThreadData td; + AVFrame *out; + + if (av_frame_is_writable(inpicref)) { + out = inpicref; + } else { + out = ff_get_video_buffer(outlink, outlink->w, outlink->h); + if (!out) { + av_frame_free(&inpicref); + return AVERROR(ENOMEM); + } + av_frame_copy_props(out, inpicref); + } + + td.in = inpicref; td.out = out; + ctx->internal->execute(ctx, filter_slice, &td, NULL, FFMIN(n->height[0], ctx->graph->nb_threads)); + emms_c(); + + if (inpicref != out) + av_frame_free(&inpicref); + return ff_filter_frame(outlink, out); +} + +static av_cold int init(AVFilterContext *ctx) +{ + NoiseContext *n = ctx->priv; + int ret, i; + int cpu_flags = av_get_cpu_flags(); + + for (i = 0; i < 4; i++) { + if (n->all.seed >= 0) + n->param[i].seed = n->all.seed; + else + n->param[i].seed = 123457; + if (n->all.strength) + n->param[i].strength = n->all.strength; + if (n->all.flags) + n->param[i].flags = n->all.flags; + } + + for (i = 0; i < 4; i++) { + if (n->param[i].strength && ((ret = init_noise(n, i)) < 0)) + return ret; + } + + n->line_noise = line_noise_c; + n->line_noise_avg = line_noise_avg_c; + + if (HAVE_MMX_INLINE && + cpu_flags & AV_CPU_FLAG_MMX) { + n->line_noise = line_noise_mmx; +#if HAVE_6REGS + n->line_noise_avg = line_noise_avg_mmx; +#endif + } + if (HAVE_MMXEXT_INLINE && + cpu_flags & AV_CPU_FLAG_MMXEXT) + n->line_noise = line_noise_mmxext; + + return 0; +} + +static av_cold void uninit(AVFilterContext *ctx) +{ + NoiseContext *n = ctx->priv; + int i; + + for (i = 0; i < 4; i++) + av_freep(&n->param[i].noise); +} + +static const AVFilterPad noise_inputs[] = { + { + .name = "default", + .type = AVMEDIA_TYPE_VIDEO, + .filter_frame = filter_frame, + .config_props = config_input, + }, + { NULL } +}; + +static const AVFilterPad noise_outputs[] = { + { + .name = "default", + .type = AVMEDIA_TYPE_VIDEO, + }, + { NULL } +}; + +AVFilter ff_vf_noise = { + .name = "noise", + .description = NULL_IF_CONFIG_SMALL("Add noise."), + .priv_size = sizeof(NoiseContext), + .init = init, + .uninit = uninit, + .query_formats = query_formats, + .inputs = noise_inputs, + .outputs = noise_outputs, + .priv_class = &noise_class, + .flags = AVFILTER_FLAG_SUPPORT_TIMELINE_GENERIC | AVFILTER_FLAG_SLICE_THREADS, +}; |