Imported Upstream version 6.1
[platform/upstream/ffmpeg.git] / libavfilter / af_volume.c
1 /*
2  * Copyright (c) 2011 Stefano Sabatini
3  * Copyright (c) 2012 Justin Ruggles <justin.ruggles@gmail.com>
4  *
5  * This file is part of FFmpeg.
6  *
7  * FFmpeg is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU Lesser General Public
9  * License as published by the Free Software Foundation; either
10  * version 2.1 of the License, or (at your option) any later version.
11  *
12  * FFmpeg is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15  * Lesser General Public License for more details.
16  *
17  * You should have received a copy of the GNU Lesser General Public
18  * License along with FFmpeg; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20  */
21
22 /**
23  * @file
24  * audio volume filter
25  */
26
27 #include "libavutil/channel_layout.h"
28 #include "libavutil/common.h"
29 #include "libavutil/eval.h"
30 #include "libavutil/ffmath.h"
31 #include "libavutil/float_dsp.h"
32 #include "libavutil/intreadwrite.h"
33 #include "libavutil/opt.h"
34 #include "libavutil/replaygain.h"
35
36 #include "audio.h"
37 #include "avfilter.h"
38 #include "formats.h"
39 #include "internal.h"
40 #include "af_volume.h"
41
42 static const char * const precision_str[] = {
43     "fixed", "float", "double"
44 };
45
46 static const char *const var_names[] = {
47     "n",                   ///< frame number (starting at zero)
48     "nb_channels",         ///< number of channels
49     "nb_consumed_samples", ///< number of samples consumed by the filter
50     "nb_samples",          ///< number of samples in the current frame
51 #if FF_API_FRAME_PKT
52     "pos",                 ///< position in the file of the frame
53 #endif
54     "pts",                 ///< frame presentation timestamp
55     "sample_rate",         ///< sample rate
56     "startpts",            ///< PTS at start of stream
57     "startt",              ///< time at start of stream
58     "t",                   ///< time in the file of the frame
59     "tb",                  ///< timebase
60     "volume",              ///< last set value
61     NULL
62 };
63
64 #define OFFSET(x) offsetof(VolumeContext, x)
65 #define A AV_OPT_FLAG_AUDIO_PARAM
66 #define F AV_OPT_FLAG_FILTERING_PARAM
67 #define T AV_OPT_FLAG_RUNTIME_PARAM
68
69 static const AVOption volume_options[] = {
70     { "volume", "set volume adjustment expression",
71             OFFSET(volume_expr), AV_OPT_TYPE_STRING, { .str = "1.0" }, .flags = A|F|T },
72     { "precision", "select mathematical precision",
73             OFFSET(precision), AV_OPT_TYPE_INT, { .i64 = PRECISION_FLOAT }, PRECISION_FIXED, PRECISION_DOUBLE, A|F, "precision" },
74         { "fixed",  "select 8-bit fixed-point",     0, AV_OPT_TYPE_CONST, { .i64 = PRECISION_FIXED  }, INT_MIN, INT_MAX, A|F, "precision" },
75         { "float",  "select 32-bit floating-point", 0, AV_OPT_TYPE_CONST, { .i64 = PRECISION_FLOAT  }, INT_MIN, INT_MAX, A|F, "precision" },
76         { "double", "select 64-bit floating-point", 0, AV_OPT_TYPE_CONST, { .i64 = PRECISION_DOUBLE }, INT_MIN, INT_MAX, A|F, "precision" },
77     { "eval", "specify when to evaluate expressions", OFFSET(eval_mode), AV_OPT_TYPE_INT, {.i64 = EVAL_MODE_ONCE}, 0, EVAL_MODE_NB-1, .flags = A|F, "eval" },
78          { "once",  "eval volume expression once", 0, AV_OPT_TYPE_CONST, {.i64=EVAL_MODE_ONCE},  .flags = A|F, .unit = "eval" },
79          { "frame", "eval volume expression per-frame",                  0, AV_OPT_TYPE_CONST, {.i64=EVAL_MODE_FRAME}, .flags = A|F, .unit = "eval" },
80     { "replaygain", "Apply replaygain side data when present",
81             OFFSET(replaygain), AV_OPT_TYPE_INT, { .i64 = REPLAYGAIN_DROP }, REPLAYGAIN_DROP, REPLAYGAIN_ALBUM, A|F, "replaygain" },
82         { "drop",   "replaygain side data is dropped", 0, AV_OPT_TYPE_CONST, { .i64 = REPLAYGAIN_DROP   }, 0, 0, A|F, "replaygain" },
83         { "ignore", "replaygain side data is ignored", 0, AV_OPT_TYPE_CONST, { .i64 = REPLAYGAIN_IGNORE }, 0, 0, A|F, "replaygain" },
84         { "track",  "track gain is preferred",         0, AV_OPT_TYPE_CONST, { .i64 = REPLAYGAIN_TRACK  }, 0, 0, A|F, "replaygain" },
85         { "album",  "album gain is preferred",         0, AV_OPT_TYPE_CONST, { .i64 = REPLAYGAIN_ALBUM  }, 0, 0, A|F, "replaygain" },
86     { "replaygain_preamp", "Apply replaygain pre-amplification",
87             OFFSET(replaygain_preamp), AV_OPT_TYPE_DOUBLE, { .dbl = 0.0 }, -15.0, 15.0, A|F },
88     { "replaygain_noclip", "Apply replaygain clipping prevention",
89             OFFSET(replaygain_noclip), AV_OPT_TYPE_BOOL, { .i64 = 1 }, 0, 1, A|F },
90     { NULL }
91 };
92
93 AVFILTER_DEFINE_CLASS(volume);
94
95 static int set_expr(AVExpr **pexpr, const char *expr, void *log_ctx)
96 {
97     int ret;
98     AVExpr *old = NULL;
99
100     if (*pexpr)
101         old = *pexpr;
102     ret = av_expr_parse(pexpr, expr, var_names,
103                         NULL, NULL, NULL, NULL, 0, log_ctx);
104     if (ret < 0) {
105         av_log(log_ctx, AV_LOG_ERROR,
106                "Error when evaluating the volume expression '%s'\n", expr);
107         *pexpr = old;
108         return ret;
109     }
110
111     av_expr_free(old);
112     return 0;
113 }
114
115 static av_cold int init(AVFilterContext *ctx)
116 {
117     VolumeContext *vol = ctx->priv;
118
119     vol->fdsp = avpriv_float_dsp_alloc(0);
120     if (!vol->fdsp)
121         return AVERROR(ENOMEM);
122
123     return set_expr(&vol->volume_pexpr, vol->volume_expr, ctx);
124 }
125
126 static av_cold void uninit(AVFilterContext *ctx)
127 {
128     VolumeContext *vol = ctx->priv;
129     av_expr_free(vol->volume_pexpr);
130     av_opt_free(vol);
131     av_freep(&vol->fdsp);
132 }
133
134 static int query_formats(AVFilterContext *ctx)
135 {
136     VolumeContext *vol = ctx->priv;
137     static const enum AVSampleFormat sample_fmts[][7] = {
138         [PRECISION_FIXED] = {
139             AV_SAMPLE_FMT_U8,
140             AV_SAMPLE_FMT_U8P,
141             AV_SAMPLE_FMT_S16,
142             AV_SAMPLE_FMT_S16P,
143             AV_SAMPLE_FMT_S32,
144             AV_SAMPLE_FMT_S32P,
145             AV_SAMPLE_FMT_NONE
146         },
147         [PRECISION_FLOAT] = {
148             AV_SAMPLE_FMT_FLT,
149             AV_SAMPLE_FMT_FLTP,
150             AV_SAMPLE_FMT_NONE
151         },
152         [PRECISION_DOUBLE] = {
153             AV_SAMPLE_FMT_DBL,
154             AV_SAMPLE_FMT_DBLP,
155             AV_SAMPLE_FMT_NONE
156         }
157     };
158     int ret = ff_set_common_all_channel_counts(ctx);
159     if (ret < 0)
160         return ret;
161
162     ret = ff_set_common_formats_from_list(ctx, sample_fmts[vol->precision]);
163     if (ret < 0)
164         return ret;
165
166     return ff_set_common_all_samplerates(ctx);
167 }
168
169 static inline void scale_samples_u8(uint8_t *dst, const uint8_t *src,
170                                     int nb_samples, int volume)
171 {
172     int i;
173     for (i = 0; i < nb_samples; i++)
174         dst[i] = av_clip_uint8(((((int64_t)src[i] - 128) * volume + 128) >> 8) + 128);
175 }
176
177 static inline void scale_samples_u8_small(uint8_t *dst, const uint8_t *src,
178                                           int nb_samples, int volume)
179 {
180     int i;
181     for (i = 0; i < nb_samples; i++)
182         dst[i] = av_clip_uint8((((src[i] - 128) * volume + 128) >> 8) + 128);
183 }
184
185 static inline void scale_samples_s16(uint8_t *dst, const uint8_t *src,
186                                      int nb_samples, int volume)
187 {
188     int i;
189     int16_t *smp_dst       = (int16_t *)dst;
190     const int16_t *smp_src = (const int16_t *)src;
191     for (i = 0; i < nb_samples; i++)
192         smp_dst[i] = av_clip_int16(((int64_t)smp_src[i] * volume + 128) >> 8);
193 }
194
195 static inline void scale_samples_s16_small(uint8_t *dst, const uint8_t *src,
196                                            int nb_samples, int volume)
197 {
198     int i;
199     int16_t *smp_dst       = (int16_t *)dst;
200     const int16_t *smp_src = (const int16_t *)src;
201     for (i = 0; i < nb_samples; i++)
202         smp_dst[i] = av_clip_int16((smp_src[i] * volume + 128) >> 8);
203 }
204
205 static inline void scale_samples_s32(uint8_t *dst, const uint8_t *src,
206                                      int nb_samples, int volume)
207 {
208     int i;
209     int32_t *smp_dst       = (int32_t *)dst;
210     const int32_t *smp_src = (const int32_t *)src;
211     for (i = 0; i < nb_samples; i++)
212         smp_dst[i] = av_clipl_int32((((int64_t)smp_src[i] * volume + 128) >> 8));
213 }
214
215 static av_cold void volume_init(VolumeContext *vol)
216 {
217     vol->samples_align = 1;
218
219     switch (av_get_packed_sample_fmt(vol->sample_fmt)) {
220     case AV_SAMPLE_FMT_U8:
221         if (vol->volume_i < 0x1000000)
222             vol->scale_samples = scale_samples_u8_small;
223         else
224             vol->scale_samples = scale_samples_u8;
225         break;
226     case AV_SAMPLE_FMT_S16:
227         if (vol->volume_i < 0x10000)
228             vol->scale_samples = scale_samples_s16_small;
229         else
230             vol->scale_samples = scale_samples_s16;
231         break;
232     case AV_SAMPLE_FMT_S32:
233         vol->scale_samples = scale_samples_s32;
234         break;
235     case AV_SAMPLE_FMT_FLT:
236         vol->samples_align = 4;
237         break;
238     case AV_SAMPLE_FMT_DBL:
239         vol->samples_align = 8;
240         break;
241     }
242
243 #if ARCH_X86
244     ff_volume_init_x86(vol);
245 #endif
246 }
247
248 static int set_volume(AVFilterContext *ctx)
249 {
250     VolumeContext *vol = ctx->priv;
251
252     vol->volume = av_expr_eval(vol->volume_pexpr, vol->var_values, NULL);
253     if (isnan(vol->volume)) {
254         if (vol->eval_mode == EVAL_MODE_ONCE) {
255             av_log(ctx, AV_LOG_ERROR, "Invalid value NaN for volume\n");
256             return AVERROR(EINVAL);
257         } else {
258             av_log(ctx, AV_LOG_WARNING, "Invalid value NaN for volume, setting to 0\n");
259             vol->volume = 0;
260         }
261     }
262     vol->var_values[VAR_VOLUME] = vol->volume;
263
264     av_log(ctx, AV_LOG_VERBOSE, "n:%f t:%f pts:%f precision:%s ",
265            vol->var_values[VAR_N], vol->var_values[VAR_T], vol->var_values[VAR_PTS],
266            precision_str[vol->precision]);
267
268     if (vol->precision == PRECISION_FIXED) {
269         vol->volume_i = (int)(vol->volume * 256 + 0.5);
270         vol->volume   = vol->volume_i / 256.0;
271         av_log(ctx, AV_LOG_VERBOSE, "volume_i:%d/255 ", vol->volume_i);
272     }
273     av_log(ctx, AV_LOG_VERBOSE, "volume:%f volume_dB:%f\n",
274            vol->volume, 20.0*log10(vol->volume));
275
276     volume_init(vol);
277     return 0;
278 }
279
280 static int config_output(AVFilterLink *outlink)
281 {
282     AVFilterContext *ctx = outlink->src;
283     VolumeContext *vol   = ctx->priv;
284     AVFilterLink *inlink = ctx->inputs[0];
285
286     vol->sample_fmt = inlink->format;
287     vol->channels   = inlink->ch_layout.nb_channels;
288     vol->planes     = av_sample_fmt_is_planar(inlink->format) ? vol->channels : 1;
289
290     vol->var_values[VAR_N] =
291     vol->var_values[VAR_NB_CONSUMED_SAMPLES] =
292     vol->var_values[VAR_NB_SAMPLES] =
293 #if FF_API_FRAME_PKT
294     vol->var_values[VAR_POS] =
295 #endif
296     vol->var_values[VAR_PTS] =
297     vol->var_values[VAR_STARTPTS] =
298     vol->var_values[VAR_STARTT] =
299     vol->var_values[VAR_T] =
300     vol->var_values[VAR_VOLUME] = NAN;
301
302     vol->var_values[VAR_NB_CHANNELS] = inlink->ch_layout.nb_channels;
303     vol->var_values[VAR_TB]          = av_q2d(inlink->time_base);
304     vol->var_values[VAR_SAMPLE_RATE] = inlink->sample_rate;
305
306     av_log(inlink->src, AV_LOG_VERBOSE, "tb:%f sample_rate:%f nb_channels:%f\n",
307            vol->var_values[VAR_TB],
308            vol->var_values[VAR_SAMPLE_RATE],
309            vol->var_values[VAR_NB_CHANNELS]);
310
311     return set_volume(ctx);
312 }
313
314 static int process_command(AVFilterContext *ctx, const char *cmd, const char *args,
315                            char *res, int res_len, int flags)
316 {
317     VolumeContext *vol = ctx->priv;
318     int ret = AVERROR(ENOSYS);
319
320     if (!strcmp(cmd, "volume")) {
321         if ((ret = set_expr(&vol->volume_pexpr, args, ctx)) < 0)
322             return ret;
323         if (vol->eval_mode == EVAL_MODE_ONCE)
324             set_volume(ctx);
325     }
326
327     return ret;
328 }
329
330 static int filter_frame(AVFilterLink *inlink, AVFrame *buf)
331 {
332     AVFilterContext *ctx = inlink->dst;
333     VolumeContext *vol    = inlink->dst->priv;
334     AVFilterLink *outlink = inlink->dst->outputs[0];
335     int nb_samples        = buf->nb_samples;
336     AVFrame *out_buf;
337     AVFrameSideData *sd = av_frame_get_side_data(buf, AV_FRAME_DATA_REPLAYGAIN);
338     int ret;
339
340     if (sd && vol->replaygain != REPLAYGAIN_IGNORE) {
341         if (vol->replaygain != REPLAYGAIN_DROP) {
342             AVReplayGain *replaygain = (AVReplayGain*)sd->data;
343             int32_t gain  = 100000;
344             uint32_t peak = 100000;
345             float g, p;
346
347             if (vol->replaygain == REPLAYGAIN_TRACK &&
348                 replaygain->track_gain != INT32_MIN) {
349                 gain = replaygain->track_gain;
350
351                 if (replaygain->track_peak != 0)
352                     peak = replaygain->track_peak;
353             } else if (replaygain->album_gain != INT32_MIN) {
354                 gain = replaygain->album_gain;
355
356                 if (replaygain->album_peak != 0)
357                     peak = replaygain->album_peak;
358             } else {
359                 av_log(inlink->dst, AV_LOG_WARNING, "Both ReplayGain gain "
360                        "values are unknown.\n");
361             }
362             g = gain / 100000.0f;
363             p = peak / 100000.0f;
364
365             av_log(inlink->dst, AV_LOG_VERBOSE,
366                    "Using gain %f dB from replaygain side data.\n", g);
367
368             vol->volume   = ff_exp10((g + vol->replaygain_preamp) / 20);
369             if (vol->replaygain_noclip)
370                 vol->volume = FFMIN(vol->volume, 1.0 / p);
371             vol->volume_i = (int)(vol->volume * 256 + 0.5);
372
373             volume_init(vol);
374         }
375         av_frame_remove_side_data(buf, AV_FRAME_DATA_REPLAYGAIN);
376     }
377
378     if (isnan(vol->var_values[VAR_STARTPTS])) {
379         vol->var_values[VAR_STARTPTS] = TS2D(buf->pts);
380         vol->var_values[VAR_STARTT  ] = TS2T(buf->pts, inlink->time_base);
381     }
382     vol->var_values[VAR_PTS] = TS2D(buf->pts);
383     vol->var_values[VAR_T  ] = TS2T(buf->pts, inlink->time_base);
384     vol->var_values[VAR_N  ] = inlink->frame_count_out;
385
386 #if FF_API_FRAME_PKT
387 FF_DISABLE_DEPRECATION_WARNINGS
388     {
389         int64_t pos;
390         pos = buf->pkt_pos;
391         vol->var_values[VAR_POS] = pos == -1 ? NAN : pos;
392     }
393 FF_ENABLE_DEPRECATION_WARNINGS
394 #endif
395     if (vol->eval_mode == EVAL_MODE_FRAME)
396         set_volume(ctx);
397
398     if (vol->volume == 1.0 || vol->volume_i == 256) {
399         out_buf = buf;
400         goto end;
401     }
402
403     /* do volume scaling in-place if input buffer is writable */
404     if (av_frame_is_writable(buf)
405             && (vol->precision != PRECISION_FIXED || vol->volume_i > 0)) {
406         out_buf = buf;
407     } else {
408         out_buf = ff_get_audio_buffer(outlink, nb_samples);
409         if (!out_buf) {
410             av_frame_free(&buf);
411             return AVERROR(ENOMEM);
412         }
413         ret = av_frame_copy_props(out_buf, buf);
414         if (ret < 0) {
415             av_frame_free(&out_buf);
416             av_frame_free(&buf);
417             return ret;
418         }
419     }
420
421     if (vol->precision != PRECISION_FIXED || vol->volume_i > 0) {
422         int p, plane_samples;
423
424         if (av_sample_fmt_is_planar(buf->format))
425             plane_samples = FFALIGN(nb_samples, vol->samples_align);
426         else
427             plane_samples = FFALIGN(nb_samples * vol->channels, vol->samples_align);
428
429         if (vol->precision == PRECISION_FIXED) {
430             for (p = 0; p < vol->planes; p++) {
431                 vol->scale_samples(out_buf->extended_data[p],
432                                    buf->extended_data[p], plane_samples,
433                                    vol->volume_i);
434             }
435         } else if (av_get_packed_sample_fmt(vol->sample_fmt) == AV_SAMPLE_FMT_FLT) {
436             for (p = 0; p < vol->planes; p++) {
437                 vol->fdsp->vector_fmul_scalar((float *)out_buf->extended_data[p],
438                                              (const float *)buf->extended_data[p],
439                                              vol->volume, plane_samples);
440             }
441         } else {
442             for (p = 0; p < vol->planes; p++) {
443                 vol->fdsp->vector_dmul_scalar((double *)out_buf->extended_data[p],
444                                              (const double *)buf->extended_data[p],
445                                              vol->volume, plane_samples);
446             }
447         }
448     }
449
450     if (buf != out_buf)
451         av_frame_free(&buf);
452
453 end:
454     vol->var_values[VAR_NB_CONSUMED_SAMPLES] += out_buf->nb_samples;
455     return ff_filter_frame(outlink, out_buf);
456 }
457
458 static const AVFilterPad avfilter_af_volume_inputs[] = {
459     {
460         .name           = "default",
461         .type           = AVMEDIA_TYPE_AUDIO,
462         .filter_frame   = filter_frame,
463     },
464 };
465
466 static const AVFilterPad avfilter_af_volume_outputs[] = {
467     {
468         .name         = "default",
469         .type         = AVMEDIA_TYPE_AUDIO,
470         .config_props = config_output,
471     },
472 };
473
474 const AVFilter ff_af_volume = {
475     .name           = "volume",
476     .description    = NULL_IF_CONFIG_SMALL("Change input volume."),
477     .priv_size      = sizeof(VolumeContext),
478     .priv_class     = &volume_class,
479     .init           = init,
480     .uninit         = uninit,
481     FILTER_INPUTS(avfilter_af_volume_inputs),
482     FILTER_OUTPUTS(avfilter_af_volume_outputs),
483     FILTER_QUERY_FUNC(query_formats),
484     .flags          = AVFILTER_FLAG_SUPPORT_TIMELINE_GENERIC,
485     .process_command = process_command,
486 };