lavfi: always check return value of ff_get_{audio,video}_buffer()
[ffmpeg.git] / libavfilter / af_atempo.c
1 /*
2  * Copyright (c) 2012 Pavel Koshevoy <pkoshevoy at gmail dot com>
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 /**
22  * @file
23  * tempo scaling audio filter -- an implementation of WSOLA algorithm
24  *
25  * Based on MIT licensed yaeAudioTempoFilter.h and yaeAudioFragment.h
26  * from Apprentice Video player by Pavel Koshevoy.
27  * https://sourceforge.net/projects/apprenticevideo/
28  *
29  * An explanation of SOLA algorithm is available at
30  * http://www.surina.net/article/time-and-pitch-scaling.html
31  *
32  * WSOLA is very similar to SOLA, only one major difference exists between
33  * these algorithms.  SOLA shifts audio fragments along the output stream,
34  * where as WSOLA shifts audio fragments along the input stream.
35  *
36  * The advantage of WSOLA algorithm is that the overlap region size is
37  * always the same, therefore the blending function is constant and
38  * can be precomputed.
39  */
40
41 #include <float.h>
42 #include "libavcodec/avfft.h"
43 #include "libavutil/avassert.h"
44 #include "libavutil/avstring.h"
45 #include "libavutil/channel_layout.h"
46 #include "libavutil/eval.h"
47 #include "libavutil/opt.h"
48 #include "libavutil/samplefmt.h"
49 #include "avfilter.h"
50 #include "audio.h"
51 #include "internal.h"
52
53 /**
54  * A fragment of audio waveform
55  */
56 typedef struct {
57     // index of the first sample of this fragment in the overall waveform;
58     // 0: input sample position
59     // 1: output sample position
60     int64_t position[2];
61
62     // original packed multi-channel samples:
63     uint8_t *data;
64
65     // number of samples in this fragment:
66     int nsamples;
67
68     // rDFT transform of the down-mixed mono fragment, used for
69     // fast waveform alignment via correlation in frequency domain:
70     FFTSample *xdat;
71 } AudioFragment;
72
73 /**
74  * Filter state machine states
75  */
76 typedef enum {
77     YAE_LOAD_FRAGMENT,
78     YAE_ADJUST_POSITION,
79     YAE_RELOAD_FRAGMENT,
80     YAE_OUTPUT_OVERLAP_ADD,
81     YAE_FLUSH_OUTPUT,
82 } FilterState;
83
84 /**
85  * Filter state machine
86  */
87 typedef struct {
88     // ring-buffer of input samples, necessary because some times
89     // input fragment position may be adjusted backwards:
90     uint8_t *buffer;
91
92     // ring-buffer maximum capacity, expressed in sample rate time base:
93     int ring;
94
95     // ring-buffer house keeping:
96     int size;
97     int head;
98     int tail;
99
100     // 0: input sample position corresponding to the ring buffer tail
101     // 1: output sample position
102     int64_t position[2];
103
104     // sample format:
105     enum AVSampleFormat format;
106
107     // number of channels:
108     int channels;
109
110     // row of bytes to skip from one sample to next, across multple channels;
111     // stride = (number-of-channels * bits-per-sample-per-channel) / 8
112     int stride;
113
114     // fragment window size, power-of-two integer:
115     int window;
116
117     // Hann window coefficients, for feathering
118     // (blending) the overlapping fragment region:
119     float *hann;
120
121     // tempo scaling factor:
122     double tempo;
123
124     // cumulative alignment drift:
125     int drift;
126
127     // current/previous fragment ring-buffer:
128     AudioFragment frag[2];
129
130     // current fragment index:
131     uint64_t nfrag;
132
133     // current state:
134     FilterState state;
135
136     // for fast correlation calculation in frequency domain:
137     RDFTContext *real_to_complex;
138     RDFTContext *complex_to_real;
139     FFTSample *correlation;
140
141     // for managing AVFilterPad.request_frame and AVFilterPad.filter_frame
142     AVFrame *dst_buffer;
143     uint8_t *dst;
144     uint8_t *dst_end;
145     uint64_t nsamples_in;
146     uint64_t nsamples_out;
147 } ATempoContext;
148
149 /**
150  * Reset filter to initial state, do not deallocate existing local buffers.
151  */
152 static void yae_clear(ATempoContext *atempo)
153 {
154     atempo->size = 0;
155     atempo->head = 0;
156     atempo->tail = 0;
157
158     atempo->drift = 0;
159     atempo->nfrag = 0;
160     atempo->state = YAE_LOAD_FRAGMENT;
161
162     atempo->position[0] = 0;
163     atempo->position[1] = 0;
164
165     atempo->frag[0].position[0] = 0;
166     atempo->frag[0].position[1] = 0;
167     atempo->frag[0].nsamples    = 0;
168
169     atempo->frag[1].position[0] = 0;
170     atempo->frag[1].position[1] = 0;
171     atempo->frag[1].nsamples    = 0;
172
173     // shift left position of 1st fragment by half a window
174     // so that no re-normalization would be required for
175     // the left half of the 1st fragment:
176     atempo->frag[0].position[0] = -(int64_t)(atempo->window / 2);
177     atempo->frag[0].position[1] = -(int64_t)(atempo->window / 2);
178
179     av_frame_free(&atempo->dst_buffer);
180     atempo->dst     = NULL;
181     atempo->dst_end = NULL;
182
183     atempo->nsamples_in       = 0;
184     atempo->nsamples_out      = 0;
185 }
186
187 /**
188  * Reset filter to initial state and deallocate all buffers.
189  */
190 static void yae_release_buffers(ATempoContext *atempo)
191 {
192     yae_clear(atempo);
193
194     av_freep(&atempo->frag[0].data);
195     av_freep(&atempo->frag[1].data);
196     av_freep(&atempo->frag[0].xdat);
197     av_freep(&atempo->frag[1].xdat);
198
199     av_freep(&atempo->buffer);
200     av_freep(&atempo->hann);
201     av_freep(&atempo->correlation);
202
203     av_rdft_end(atempo->real_to_complex);
204     atempo->real_to_complex = NULL;
205
206     av_rdft_end(atempo->complex_to_real);
207     atempo->complex_to_real = NULL;
208 }
209
210 /* av_realloc is not aligned enough; fortunately, the data does not need to
211  * be preserved */
212 #define RE_MALLOC_OR_FAIL(field, field_size)                    \
213     do {                                                        \
214         av_freep(&field);                                       \
215         field = av_malloc(field_size);                          \
216         if (!field) {                                           \
217             yae_release_buffers(atempo);                        \
218             return AVERROR(ENOMEM);                             \
219         }                                                       \
220     } while (0)
221
222 /**
223  * Prepare filter for processing audio data of given format,
224  * sample rate and number of channels.
225  */
226 static int yae_reset(ATempoContext *atempo,
227                      enum AVSampleFormat format,
228                      int sample_rate,
229                      int channels)
230 {
231     const int sample_size = av_get_bytes_per_sample(format);
232     uint32_t nlevels  = 0;
233     uint32_t pot;
234     int i;
235
236     atempo->format   = format;
237     atempo->channels = channels;
238     atempo->stride   = sample_size * channels;
239
240     // pick a segment window size:
241     atempo->window = sample_rate / 24;
242
243     // adjust window size to be a power-of-two integer:
244     nlevels = av_log2(atempo->window);
245     pot = 1 << nlevels;
246     av_assert0(pot <= atempo->window);
247
248     if (pot < atempo->window) {
249         atempo->window = pot * 2;
250         nlevels++;
251     }
252
253     // initialize audio fragment buffers:
254     RE_MALLOC_OR_FAIL(atempo->frag[0].data, atempo->window * atempo->stride);
255     RE_MALLOC_OR_FAIL(atempo->frag[1].data, atempo->window * atempo->stride);
256     RE_MALLOC_OR_FAIL(atempo->frag[0].xdat, atempo->window * sizeof(FFTComplex));
257     RE_MALLOC_OR_FAIL(atempo->frag[1].xdat, atempo->window * sizeof(FFTComplex));
258
259     // initialize rDFT contexts:
260     av_rdft_end(atempo->real_to_complex);
261     atempo->real_to_complex = NULL;
262
263     av_rdft_end(atempo->complex_to_real);
264     atempo->complex_to_real = NULL;
265
266     atempo->real_to_complex = av_rdft_init(nlevels + 1, DFT_R2C);
267     if (!atempo->real_to_complex) {
268         yae_release_buffers(atempo);
269         return AVERROR(ENOMEM);
270     }
271
272     atempo->complex_to_real = av_rdft_init(nlevels + 1, IDFT_C2R);
273     if (!atempo->complex_to_real) {
274         yae_release_buffers(atempo);
275         return AVERROR(ENOMEM);
276     }
277
278     RE_MALLOC_OR_FAIL(atempo->correlation, atempo->window * sizeof(FFTComplex));
279
280     atempo->ring = atempo->window * 3;
281     RE_MALLOC_OR_FAIL(atempo->buffer, atempo->ring * atempo->stride);
282
283     // initialize the Hann window function:
284     RE_MALLOC_OR_FAIL(atempo->hann, atempo->window * sizeof(float));
285
286     for (i = 0; i < atempo->window; i++) {
287         double t = (double)i / (double)(atempo->window - 1);
288         double h = 0.5 * (1.0 - cos(2.0 * M_PI * t));
289         atempo->hann[i] = (float)h;
290     }
291
292     yae_clear(atempo);
293     return 0;
294 }
295
296 static int yae_set_tempo(AVFilterContext *ctx, const char *arg_tempo)
297 {
298     ATempoContext *atempo = ctx->priv;
299     char   *tail = NULL;
300     double tempo = av_strtod(arg_tempo, &tail);
301
302     if (tail && *tail) {
303         av_log(ctx, AV_LOG_ERROR, "Invalid tempo value '%s'\n", arg_tempo);
304         return AVERROR(EINVAL);
305     }
306
307     if (tempo < 0.5 || tempo > 2.0) {
308         av_log(ctx, AV_LOG_ERROR, "Tempo value %f exceeds [0.5, 2.0] range\n",
309                tempo);
310         return AVERROR(EINVAL);
311     }
312
313     atempo->tempo = tempo;
314     return 0;
315 }
316
317 inline static AudioFragment *yae_curr_frag(ATempoContext *atempo)
318 {
319     return &atempo->frag[atempo->nfrag % 2];
320 }
321
322 inline static AudioFragment *yae_prev_frag(ATempoContext *atempo)
323 {
324     return &atempo->frag[(atempo->nfrag + 1) % 2];
325 }
326
327 /**
328  * A helper macro for initializing complex data buffer with scalar data
329  * of a given type.
330  */
331 #define yae_init_xdat(scalar_type, scalar_max)                          \
332     do {                                                                \
333         const uint8_t *src_end = src +                                  \
334             frag->nsamples * atempo->channels * sizeof(scalar_type);    \
335                                                                         \
336         FFTSample *xdat = frag->xdat;                                   \
337         scalar_type tmp;                                                \
338                                                                         \
339         if (atempo->channels == 1) {                                    \
340             for (; src < src_end; xdat++) {                             \
341                 tmp = *(const scalar_type *)src;                        \
342                 src += sizeof(scalar_type);                             \
343                                                                         \
344                 *xdat = (FFTSample)tmp;                                 \
345             }                                                           \
346         } else {                                                        \
347             FFTSample s, max, ti, si;                                   \
348             int i;                                                      \
349                                                                         \
350             for (; src < src_end; xdat++) {                             \
351                 tmp = *(const scalar_type *)src;                        \
352                 src += sizeof(scalar_type);                             \
353                                                                         \
354                 max = (FFTSample)tmp;                                   \
355                 s = FFMIN((FFTSample)scalar_max,                        \
356                           (FFTSample)fabsf(max));                       \
357                                                                         \
358                 for (i = 1; i < atempo->channels; i++) {                \
359                     tmp = *(const scalar_type *)src;                    \
360                     src += sizeof(scalar_type);                         \
361                                                                         \
362                     ti = (FFTSample)tmp;                                \
363                     si = FFMIN((FFTSample)scalar_max,                   \
364                                (FFTSample)fabsf(ti));                   \
365                                                                         \
366                     if (s < si) {                                       \
367                         s   = si;                                       \
368                         max = ti;                                       \
369                     }                                                   \
370                 }                                                       \
371                                                                         \
372                 *xdat = max;                                            \
373             }                                                           \
374         }                                                               \
375     } while (0)
376
377 /**
378  * Initialize complex data buffer of a given audio fragment
379  * with down-mixed mono data of appropriate scalar type.
380  */
381 static void yae_downmix(ATempoContext *atempo, AudioFragment *frag)
382 {
383     // shortcuts:
384     const uint8_t *src = frag->data;
385
386     // init complex data buffer used for FFT and Correlation:
387     memset(frag->xdat, 0, sizeof(FFTComplex) * atempo->window);
388
389     if (atempo->format == AV_SAMPLE_FMT_U8) {
390         yae_init_xdat(uint8_t, 127);
391     } else if (atempo->format == AV_SAMPLE_FMT_S16) {
392         yae_init_xdat(int16_t, 32767);
393     } else if (atempo->format == AV_SAMPLE_FMT_S32) {
394         yae_init_xdat(int, 2147483647);
395     } else if (atempo->format == AV_SAMPLE_FMT_FLT) {
396         yae_init_xdat(float, 1);
397     } else if (atempo->format == AV_SAMPLE_FMT_DBL) {
398         yae_init_xdat(double, 1);
399     }
400 }
401
402 /**
403  * Populate the internal data buffer on as-needed basis.
404  *
405  * @return
406  *   0 if requested data was already available or was successfully loaded,
407  *   AVERROR(EAGAIN) if more input data is required.
408  */
409 static int yae_load_data(ATempoContext *atempo,
410                          const uint8_t **src_ref,
411                          const uint8_t *src_end,
412                          int64_t stop_here)
413 {
414     // shortcut:
415     const uint8_t *src = *src_ref;
416     const int read_size = stop_here - atempo->position[0];
417
418     if (stop_here <= atempo->position[0]) {
419         return 0;
420     }
421
422     // samples are not expected to be skipped:
423     av_assert0(read_size <= atempo->ring);
424
425     while (atempo->position[0] < stop_here && src < src_end) {
426         int src_samples = (src_end - src) / atempo->stride;
427
428         // load data piece-wise, in order to avoid complicating the logic:
429         int nsamples = FFMIN(read_size, src_samples);
430         int na;
431         int nb;
432
433         nsamples = FFMIN(nsamples, atempo->ring);
434         na = FFMIN(nsamples, atempo->ring - atempo->tail);
435         nb = FFMIN(nsamples - na, atempo->ring);
436
437         if (na) {
438             uint8_t *a = atempo->buffer + atempo->tail * atempo->stride;
439             memcpy(a, src, na * atempo->stride);
440
441             src += na * atempo->stride;
442             atempo->position[0] += na;
443
444             atempo->size = FFMIN(atempo->size + na, atempo->ring);
445             atempo->tail = (atempo->tail + na) % atempo->ring;
446             atempo->head =
447                 atempo->size < atempo->ring ?
448                 atempo->tail - atempo->size :
449                 atempo->tail;
450         }
451
452         if (nb) {
453             uint8_t *b = atempo->buffer;
454             memcpy(b, src, nb * atempo->stride);
455
456             src += nb * atempo->stride;
457             atempo->position[0] += nb;
458
459             atempo->size = FFMIN(atempo->size + nb, atempo->ring);
460             atempo->tail = (atempo->tail + nb) % atempo->ring;
461             atempo->head =
462                 atempo->size < atempo->ring ?
463                 atempo->tail - atempo->size :
464                 atempo->tail;
465         }
466     }
467
468     // pass back the updated source buffer pointer:
469     *src_ref = src;
470
471     // sanity check:
472     av_assert0(atempo->position[0] <= stop_here);
473
474     return atempo->position[0] == stop_here ? 0 : AVERROR(EAGAIN);
475 }
476
477 /**
478  * Populate current audio fragment data buffer.
479  *
480  * @return
481  *   0 when the fragment is ready,
482  *   AVERROR(EAGAIN) if more input data is required.
483  */
484 static int yae_load_frag(ATempoContext *atempo,
485                          const uint8_t **src_ref,
486                          const uint8_t *src_end)
487 {
488     // shortcuts:
489     AudioFragment *frag = yae_curr_frag(atempo);
490     uint8_t *dst;
491     int64_t missing, start, zeros;
492     uint32_t nsamples;
493     const uint8_t *a, *b;
494     int i0, i1, n0, n1, na, nb;
495
496     int64_t stop_here = frag->position[0] + atempo->window;
497     if (src_ref && yae_load_data(atempo, src_ref, src_end, stop_here) != 0) {
498         return AVERROR(EAGAIN);
499     }
500
501     // calculate the number of samples we don't have:
502     missing =
503         stop_here > atempo->position[0] ?
504         stop_here - atempo->position[0] : 0;
505
506     nsamples =
507         missing < (int64_t)atempo->window ?
508         (uint32_t)(atempo->window - missing) : 0;
509
510     // setup the output buffer:
511     frag->nsamples = nsamples;
512     dst = frag->data;
513
514     start = atempo->position[0] - atempo->size;
515     zeros = 0;
516
517     if (frag->position[0] < start) {
518         // what we don't have we substitute with zeros:
519         zeros = FFMIN(start - frag->position[0], (int64_t)nsamples);
520         av_assert0(zeros != nsamples);
521
522         memset(dst, 0, zeros * atempo->stride);
523         dst += zeros * atempo->stride;
524     }
525
526     if (zeros == nsamples) {
527         return 0;
528     }
529
530     // get the remaining data from the ring buffer:
531     na = (atempo->head < atempo->tail ?
532           atempo->tail - atempo->head :
533           atempo->ring - atempo->head);
534
535     nb = atempo->head < atempo->tail ? 0 : atempo->tail;
536
537     // sanity check:
538     av_assert0(nsamples <= zeros + na + nb);
539
540     a = atempo->buffer + atempo->head * atempo->stride;
541     b = atempo->buffer;
542
543     i0 = frag->position[0] + zeros - start;
544     i1 = i0 < na ? 0 : i0 - na;
545
546     n0 = i0 < na ? FFMIN(na - i0, (int)(nsamples - zeros)) : 0;
547     n1 = nsamples - zeros - n0;
548
549     if (n0) {
550         memcpy(dst, a + i0 * atempo->stride, n0 * atempo->stride);
551         dst += n0 * atempo->stride;
552     }
553
554     if (n1) {
555         memcpy(dst, b + i1 * atempo->stride, n1 * atempo->stride);
556     }
557
558     return 0;
559 }
560
561 /**
562  * Prepare for loading next audio fragment.
563  */
564 static void yae_advance_to_next_frag(ATempoContext *atempo)
565 {
566     const double fragment_step = atempo->tempo * (double)(atempo->window / 2);
567
568     const AudioFragment *prev;
569     AudioFragment       *frag;
570
571     atempo->nfrag++;
572     prev = yae_prev_frag(atempo);
573     frag = yae_curr_frag(atempo);
574
575     frag->position[0] = prev->position[0] + (int64_t)fragment_step;
576     frag->position[1] = prev->position[1] + atempo->window / 2;
577     frag->nsamples    = 0;
578 }
579
580 /**
581  * Calculate cross-correlation via rDFT.
582  *
583  * Multiply two vectors of complex numbers (result of real_to_complex rDFT)
584  * and transform back via complex_to_real rDFT.
585  */
586 static void yae_xcorr_via_rdft(FFTSample *xcorr,
587                                RDFTContext *complex_to_real,
588                                const FFTComplex *xa,
589                                const FFTComplex *xb,
590                                const int window)
591 {
592     FFTComplex *xc = (FFTComplex *)xcorr;
593     int i;
594
595     // NOTE: first element requires special care -- Given Y = rDFT(X),
596     // Im(Y[0]) and Im(Y[N/2]) are always zero, therefore av_rdft_calc
597     // stores Re(Y[N/2]) in place of Im(Y[0]).
598
599     xc->re = xa->re * xb->re;
600     xc->im = xa->im * xb->im;
601     xa++;
602     xb++;
603     xc++;
604
605     for (i = 1; i < window; i++, xa++, xb++, xc++) {
606         xc->re = (xa->re * xb->re + xa->im * xb->im);
607         xc->im = (xa->im * xb->re - xa->re * xb->im);
608     }
609
610     // apply inverse rDFT:
611     av_rdft_calc(complex_to_real, xcorr);
612 }
613
614 /**
615  * Calculate alignment offset for given fragment
616  * relative to the previous fragment.
617  *
618  * @return alignment offset of current fragment relative to previous.
619  */
620 static int yae_align(AudioFragment *frag,
621                      const AudioFragment *prev,
622                      const int window,
623                      const int delta_max,
624                      const int drift,
625                      FFTSample *correlation,
626                      RDFTContext *complex_to_real)
627 {
628     int       best_offset = -drift;
629     FFTSample best_metric = -FLT_MAX;
630     FFTSample *xcorr;
631
632     int i0;
633     int i1;
634     int i;
635
636     yae_xcorr_via_rdft(correlation,
637                        complex_to_real,
638                        (const FFTComplex *)prev->xdat,
639                        (const FFTComplex *)frag->xdat,
640                        window);
641
642     // identify search window boundaries:
643     i0 = FFMAX(window / 2 - delta_max - drift, 0);
644     i0 = FFMIN(i0, window);
645
646     i1 = FFMIN(window / 2 + delta_max - drift, window - window / 16);
647     i1 = FFMAX(i1, 0);
648
649     // identify cross-correlation peaks within search window:
650     xcorr = correlation + i0;
651
652     for (i = i0; i < i1; i++, xcorr++) {
653         FFTSample metric = *xcorr;
654
655         // normalize:
656         FFTSample drifti = (FFTSample)(drift + i);
657         metric *= drifti * (FFTSample)(i - i0) * (FFTSample)(i1 - i);
658
659         if (metric > best_metric) {
660             best_metric = metric;
661             best_offset = i - window / 2;
662         }
663     }
664
665     return best_offset;
666 }
667
668 /**
669  * Adjust current fragment position for better alignment
670  * with previous fragment.
671  *
672  * @return alignment correction.
673  */
674 static int yae_adjust_position(ATempoContext *atempo)
675 {
676     const AudioFragment *prev = yae_prev_frag(atempo);
677     AudioFragment       *frag = yae_curr_frag(atempo);
678
679     const int delta_max  = atempo->window / 2;
680     const int correction = yae_align(frag,
681                                      prev,
682                                      atempo->window,
683                                      delta_max,
684                                      atempo->drift,
685                                      atempo->correlation,
686                                      atempo->complex_to_real);
687
688     if (correction) {
689         // adjust fragment position:
690         frag->position[0] -= correction;
691
692         // clear so that the fragment can be reloaded:
693         frag->nsamples = 0;
694
695         // update cumulative correction drift counter:
696         atempo->drift += correction;
697     }
698
699     return correction;
700 }
701
702 /**
703  * A helper macro for blending the overlap region of previous
704  * and current audio fragment.
705  */
706 #define yae_blend(scalar_type)                                          \
707     do {                                                                \
708         const scalar_type *aaa = (const scalar_type *)a;                \
709         const scalar_type *bbb = (const scalar_type *)b;                \
710                                                                         \
711         scalar_type *out     = (scalar_type *)dst;                      \
712         scalar_type *out_end = (scalar_type *)dst_end;                  \
713         int64_t i;                                                      \
714                                                                         \
715         for (i = 0; i < overlap && out < out_end;                       \
716              i++, atempo->position[1]++, wa++, wb++) {                  \
717             float w0 = *wa;                                             \
718             float w1 = *wb;                                             \
719             int j;                                                      \
720                                                                         \
721             for (j = 0; j < atempo->channels;                           \
722                  j++, aaa++, bbb++, out++) {                            \
723                 float t0 = (float)*aaa;                                 \
724                 float t1 = (float)*bbb;                                 \
725                                                                         \
726                 *out =                                                  \
727                     frag->position[0] + i < 0 ?                         \
728                     *aaa :                                              \
729                     (scalar_type)(t0 * w0 + t1 * w1);                   \
730             }                                                           \
731         }                                                               \
732         dst = (uint8_t *)out;                                           \
733     } while (0)
734
735 /**
736  * Blend the overlap region of previous and current audio fragment
737  * and output the results to the given destination buffer.
738  *
739  * @return
740  *   0 if the overlap region was completely stored in the dst buffer,
741  *   AVERROR(EAGAIN) if more destination buffer space is required.
742  */
743 static int yae_overlap_add(ATempoContext *atempo,
744                            uint8_t **dst_ref,
745                            uint8_t *dst_end)
746 {
747     // shortcuts:
748     const AudioFragment *prev = yae_prev_frag(atempo);
749     const AudioFragment *frag = yae_curr_frag(atempo);
750
751     const int64_t start_here = FFMAX(atempo->position[1],
752                                      frag->position[1]);
753
754     const int64_t stop_here = FFMIN(prev->position[1] + prev->nsamples,
755                                     frag->position[1] + frag->nsamples);
756
757     const int64_t overlap = stop_here - start_here;
758
759     const int64_t ia = start_here - prev->position[1];
760     const int64_t ib = start_here - frag->position[1];
761
762     const float *wa = atempo->hann + ia;
763     const float *wb = atempo->hann + ib;
764
765     const uint8_t *a = prev->data + ia * atempo->stride;
766     const uint8_t *b = frag->data + ib * atempo->stride;
767
768     uint8_t *dst = *dst_ref;
769
770     av_assert0(start_here <= stop_here &&
771                frag->position[1] <= start_here &&
772                overlap <= frag->nsamples);
773
774     if (atempo->format == AV_SAMPLE_FMT_U8) {
775         yae_blend(uint8_t);
776     } else if (atempo->format == AV_SAMPLE_FMT_S16) {
777         yae_blend(int16_t);
778     } else if (atempo->format == AV_SAMPLE_FMT_S32) {
779         yae_blend(int);
780     } else if (atempo->format == AV_SAMPLE_FMT_FLT) {
781         yae_blend(float);
782     } else if (atempo->format == AV_SAMPLE_FMT_DBL) {
783         yae_blend(double);
784     }
785
786     // pass-back the updated destination buffer pointer:
787     *dst_ref = dst;
788
789     return atempo->position[1] == stop_here ? 0 : AVERROR(EAGAIN);
790 }
791
792 /**
793  * Feed as much data to the filter as it is able to consume
794  * and receive as much processed data in the destination buffer
795  * as it is able to produce or store.
796  */
797 static void
798 yae_apply(ATempoContext *atempo,
799           const uint8_t **src_ref,
800           const uint8_t *src_end,
801           uint8_t **dst_ref,
802           uint8_t *dst_end)
803 {
804     while (1) {
805         if (atempo->state == YAE_LOAD_FRAGMENT) {
806             // load additional data for the current fragment:
807             if (yae_load_frag(atempo, src_ref, src_end) != 0) {
808                 break;
809             }
810
811             // down-mix to mono:
812             yae_downmix(atempo, yae_curr_frag(atempo));
813
814             // apply rDFT:
815             av_rdft_calc(atempo->real_to_complex, yae_curr_frag(atempo)->xdat);
816
817             // must load the second fragment before alignment can start:
818             if (!atempo->nfrag) {
819                 yae_advance_to_next_frag(atempo);
820                 continue;
821             }
822
823             atempo->state = YAE_ADJUST_POSITION;
824         }
825
826         if (atempo->state == YAE_ADJUST_POSITION) {
827             // adjust position for better alignment:
828             if (yae_adjust_position(atempo)) {
829                 // reload the fragment at the corrected position, so that the
830                 // Hann window blending would not require normalization:
831                 atempo->state = YAE_RELOAD_FRAGMENT;
832             } else {
833                 atempo->state = YAE_OUTPUT_OVERLAP_ADD;
834             }
835         }
836
837         if (atempo->state == YAE_RELOAD_FRAGMENT) {
838             // load additional data if necessary due to position adjustment:
839             if (yae_load_frag(atempo, src_ref, src_end) != 0) {
840                 break;
841             }
842
843             // down-mix to mono:
844             yae_downmix(atempo, yae_curr_frag(atempo));
845
846             // apply rDFT:
847             av_rdft_calc(atempo->real_to_complex, yae_curr_frag(atempo)->xdat);
848
849             atempo->state = YAE_OUTPUT_OVERLAP_ADD;
850         }
851
852         if (atempo->state == YAE_OUTPUT_OVERLAP_ADD) {
853             // overlap-add and output the result:
854             if (yae_overlap_add(atempo, dst_ref, dst_end) != 0) {
855                 break;
856             }
857
858             // advance to the next fragment, repeat:
859             yae_advance_to_next_frag(atempo);
860             atempo->state = YAE_LOAD_FRAGMENT;
861         }
862     }
863 }
864
865 /**
866  * Flush any buffered data from the filter.
867  *
868  * @return
869  *   0 if all data was completely stored in the dst buffer,
870  *   AVERROR(EAGAIN) if more destination buffer space is required.
871  */
872 static int yae_flush(ATempoContext *atempo,
873                      uint8_t **dst_ref,
874                      uint8_t *dst_end)
875 {
876     AudioFragment *frag = yae_curr_frag(atempo);
877     int64_t overlap_end;
878     int64_t start_here;
879     int64_t stop_here;
880     int64_t offset;
881
882     const uint8_t *src;
883     uint8_t *dst;
884
885     int src_size;
886     int dst_size;
887     int nbytes;
888
889     atempo->state = YAE_FLUSH_OUTPUT;
890
891     if (atempo->position[0] == frag->position[0] + frag->nsamples &&
892         atempo->position[1] == frag->position[1] + frag->nsamples) {
893         // the current fragment is already flushed:
894         return 0;
895     }
896
897     if (frag->position[0] + frag->nsamples < atempo->position[0]) {
898         // finish loading the current (possibly partial) fragment:
899         yae_load_frag(atempo, NULL, NULL);
900
901         if (atempo->nfrag) {
902             // down-mix to mono:
903             yae_downmix(atempo, frag);
904
905             // apply rDFT:
906             av_rdft_calc(atempo->real_to_complex, frag->xdat);
907
908             // align current fragment to previous fragment:
909             if (yae_adjust_position(atempo)) {
910                 // reload the current fragment due to adjusted position:
911                 yae_load_frag(atempo, NULL, NULL);
912             }
913         }
914     }
915
916     // flush the overlap region:
917     overlap_end = frag->position[1] + FFMIN(atempo->window / 2,
918                                             frag->nsamples);
919
920     while (atempo->position[1] < overlap_end) {
921         if (yae_overlap_add(atempo, dst_ref, dst_end) != 0) {
922             return AVERROR(EAGAIN);
923         }
924     }
925
926     // flush the remaininder of the current fragment:
927     start_here = FFMAX(atempo->position[1], overlap_end);
928     stop_here  = frag->position[1] + frag->nsamples;
929     offset     = start_here - frag->position[1];
930     av_assert0(start_here <= stop_here && frag->position[1] <= start_here);
931
932     src = frag->data + offset * atempo->stride;
933     dst = (uint8_t *)*dst_ref;
934
935     src_size = (int)(stop_here - start_here) * atempo->stride;
936     dst_size = dst_end - dst;
937     nbytes = FFMIN(src_size, dst_size);
938
939     memcpy(dst, src, nbytes);
940     dst += nbytes;
941
942     atempo->position[1] += (nbytes / atempo->stride);
943
944     // pass-back the updated destination buffer pointer:
945     *dst_ref = (uint8_t *)dst;
946
947     return atempo->position[1] == stop_here ? 0 : AVERROR(EAGAIN);
948 }
949
950 static av_cold int init(AVFilterContext *ctx, const char *args)
951 {
952     ATempoContext *atempo = ctx->priv;
953
954     // NOTE: this assumes that the caller has memset ctx->priv to 0:
955     atempo->format = AV_SAMPLE_FMT_NONE;
956     atempo->tempo  = 1.0;
957     atempo->state  = YAE_LOAD_FRAGMENT;
958
959     return args ? yae_set_tempo(ctx, args) : 0;
960 }
961
962 static av_cold void uninit(AVFilterContext *ctx)
963 {
964     ATempoContext *atempo = ctx->priv;
965     yae_release_buffers(atempo);
966 }
967
968 static int query_formats(AVFilterContext *ctx)
969 {
970     AVFilterChannelLayouts *layouts = NULL;
971     AVFilterFormats        *formats = NULL;
972
973     // WSOLA necessitates an internal sliding window ring buffer
974     // for incoming audio stream.
975     //
976     // Planar sample formats are too cumbersome to store in a ring buffer,
977     // therefore planar sample formats are not supported.
978     //
979     static const enum AVSampleFormat sample_fmts[] = {
980         AV_SAMPLE_FMT_U8,
981         AV_SAMPLE_FMT_S16,
982         AV_SAMPLE_FMT_S32,
983         AV_SAMPLE_FMT_FLT,
984         AV_SAMPLE_FMT_DBL,
985         AV_SAMPLE_FMT_NONE
986     };
987
988     layouts = ff_all_channel_layouts();
989     if (!layouts) {
990         return AVERROR(ENOMEM);
991     }
992     ff_set_common_channel_layouts(ctx, layouts);
993
994     formats = ff_make_format_list(sample_fmts);
995     if (!formats) {
996         return AVERROR(ENOMEM);
997     }
998     ff_set_common_formats(ctx, formats);
999
1000     formats = ff_all_samplerates();
1001     if (!formats) {
1002         return AVERROR(ENOMEM);
1003     }
1004     ff_set_common_samplerates(ctx, formats);
1005
1006     return 0;
1007 }
1008
1009 static int config_props(AVFilterLink *inlink)
1010 {
1011     AVFilterContext  *ctx = inlink->dst;
1012     ATempoContext *atempo = ctx->priv;
1013
1014     enum AVSampleFormat format = inlink->format;
1015     int sample_rate = (int)inlink->sample_rate;
1016     int channels = av_get_channel_layout_nb_channels(inlink->channel_layout);
1017
1018     ctx->outputs[0]->flags |= FF_LINK_FLAG_REQUEST_LOOP;
1019
1020     return yae_reset(atempo, format, sample_rate, channels);
1021 }
1022
1023 static int push_samples(ATempoContext *atempo,
1024                         AVFilterLink *outlink,
1025                         int n_out)
1026 {
1027     int ret;
1028
1029     atempo->dst_buffer->sample_rate = outlink->sample_rate;
1030     atempo->dst_buffer->nb_samples  = n_out;
1031
1032     // adjust the PTS:
1033     atempo->dst_buffer->pts =
1034         av_rescale_q(atempo->nsamples_out,
1035                      (AVRational){ 1, outlink->sample_rate },
1036                      outlink->time_base);
1037
1038     ret = ff_filter_frame(outlink, atempo->dst_buffer);
1039     if (ret < 0)
1040         return ret;
1041     atempo->dst_buffer = NULL;
1042     atempo->dst        = NULL;
1043     atempo->dst_end    = NULL;
1044
1045     atempo->nsamples_out += n_out;
1046     return 0;
1047 }
1048
1049 static int filter_frame(AVFilterLink *inlink, AVFrame *src_buffer)
1050 {
1051     AVFilterContext  *ctx = inlink->dst;
1052     ATempoContext *atempo = ctx->priv;
1053     AVFilterLink *outlink = ctx->outputs[0];
1054
1055     int ret = 0;
1056     int n_in = src_buffer->nb_samples;
1057     int n_out = (int)(0.5 + ((double)n_in) / atempo->tempo);
1058
1059     const uint8_t *src = src_buffer->data[0];
1060     const uint8_t *src_end = src + n_in * atempo->stride;
1061
1062     while (src < src_end) {
1063         if (!atempo->dst_buffer) {
1064             atempo->dst_buffer = ff_get_audio_buffer(outlink, n_out);
1065             if (!atempo->dst_buffer)
1066                 return AVERROR(ENOMEM);
1067             av_frame_copy_props(atempo->dst_buffer, src_buffer);
1068
1069             atempo->dst = atempo->dst_buffer->data[0];
1070             atempo->dst_end = atempo->dst + n_out * atempo->stride;
1071         }
1072
1073         yae_apply(atempo, &src, src_end, &atempo->dst, atempo->dst_end);
1074
1075         if (atempo->dst == atempo->dst_end) {
1076             ret = push_samples(atempo, outlink, n_out);
1077             if (ret < 0)
1078                 goto end;
1079         }
1080     }
1081
1082     atempo->nsamples_in += n_in;
1083 end:
1084     av_frame_free(&src_buffer);
1085     return ret;
1086 }
1087
1088 static int request_frame(AVFilterLink *outlink)
1089 {
1090     AVFilterContext  *ctx = outlink->src;
1091     ATempoContext *atempo = ctx->priv;
1092     int ret;
1093
1094     ret = ff_request_frame(ctx->inputs[0]);
1095
1096     if (ret == AVERROR_EOF) {
1097         // flush the filter:
1098         int n_max = atempo->ring;
1099         int n_out;
1100         int err = AVERROR(EAGAIN);
1101
1102         while (err == AVERROR(EAGAIN)) {
1103             if (!atempo->dst_buffer) {
1104                 atempo->dst_buffer = ff_get_audio_buffer(outlink, n_max);
1105                 if (!atempo->dst_buffer)
1106                     return AVERROR(ENOMEM);
1107
1108                 atempo->dst = atempo->dst_buffer->data[0];
1109                 atempo->dst_end = atempo->dst + n_max * atempo->stride;
1110             }
1111
1112             err = yae_flush(atempo, &atempo->dst, atempo->dst_end);
1113
1114             n_out = ((atempo->dst - atempo->dst_buffer->data[0]) /
1115                      atempo->stride);
1116
1117             if (n_out) {
1118                 ret = push_samples(atempo, outlink, n_out);
1119             }
1120         }
1121
1122         av_frame_free(&atempo->dst_buffer);
1123         atempo->dst     = NULL;
1124         atempo->dst_end = NULL;
1125
1126         return AVERROR_EOF;
1127     }
1128
1129     return ret;
1130 }
1131
1132 static int process_command(AVFilterContext *ctx,
1133                            const char *cmd,
1134                            const char *arg,
1135                            char *res,
1136                            int res_len,
1137                            int flags)
1138 {
1139     return !strcmp(cmd, "tempo") ? yae_set_tempo(ctx, arg) : AVERROR(ENOSYS);
1140 }
1141
1142 static const AVFilterPad atempo_inputs[] = {
1143     {
1144         .name         = "default",
1145         .type         = AVMEDIA_TYPE_AUDIO,
1146         .filter_frame = filter_frame,
1147         .config_props = config_props,
1148     },
1149     { NULL }
1150 };
1151
1152 static const AVFilterPad atempo_outputs[] = {
1153     {
1154         .name          = "default",
1155         .request_frame = request_frame,
1156         .type          = AVMEDIA_TYPE_AUDIO,
1157     },
1158     { NULL }
1159 };
1160
1161 AVFilter avfilter_af_atempo = {
1162     .name            = "atempo",
1163     .description     = NULL_IF_CONFIG_SMALL("Adjust audio tempo."),
1164     .init            = init,
1165     .uninit          = uninit,
1166     .query_formats   = query_formats,
1167     .process_command = process_command,
1168     .priv_size       = sizeof(ATempoContext),
1169     .inputs          = atempo_inputs,
1170     .outputs         = atempo_outputs,
1171 };