Subversion Repositories Kolibri OS

/*

 * Copyright (c) 2002 Michael Niedermayer 

 * 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; fmt < AV_PIX_FMT_NB; 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

    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;

        n->line_noise_avg = line_noise_avg_mmx;

    }

    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 avfilter_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,

};