mirror of
https://gitlab.freedesktop.org/gstreamer/gstreamer.git
synced 2024-12-01 06:01:04 +00:00
1b6c70bf0b
Original commit message from CVS: * gst/filter/gstbpwsinc.c: (bpwsinc_transform): * gst/filter/gstlpwsinc.c: (lpwsinc_transform): The transform() methods are not called in passthrough mode so there's no need for checking if the element is in passthrough mode.
884 lines
27 KiB
C
884 lines
27 KiB
C
/* -*- c-basic-offset: 2 -*-
|
|
*
|
|
* GStreamer
|
|
* Copyright (C) 1999-2001 Erik Walthinsen <omega@cse.ogi.edu>
|
|
* 2006 Dreamlab Technologies Ltd. <mathis.hofer@dreamlab.net>
|
|
* 2007 Sebastian Dröge <slomo@circular-chaos.org>
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Library General Public
|
|
* License as published by the Free Software Foundation; either
|
|
* version 2 of the License, or (at your option) any later version.
|
|
*
|
|
* This library 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
|
|
* Library General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Library General Public
|
|
* License along with this library; if not, write to the
|
|
* Free Software Foundation, Inc., 59 Temple Place - Suite 330,
|
|
* Boston, MA 02111-1307, USA.
|
|
*
|
|
*
|
|
* this windowed sinc filter is taken from the freely downloadable DSP book,
|
|
* "The Scientist and Engineer's Guide to Digital Signal Processing",
|
|
* chapter 16
|
|
* available at http://www.dspguide.com/
|
|
*
|
|
* TODO: - Implement the convolution in place, probably only makes sense
|
|
* when using FFT convolution as currently the convolution itself
|
|
* is probably the bottleneck
|
|
* - Maybe allow cascading the filter to get a better stopband attenuation.
|
|
* Can be done by convolving a filter kernel with itself
|
|
* - Drop the first kernel_length/2 samples and append the same number of
|
|
* samples on EOS as the first few samples are essentialy zero.
|
|
*/
|
|
|
|
/**
|
|
* SECTION:element-bpwsinc
|
|
* @short_description: Windowed Sinc band pass and band reject filter
|
|
*
|
|
* <refsect2>
|
|
* <para>
|
|
* Attenuates all frequencies outside (bandpass) or inside (bandreject) of a frequency
|
|
* band. The length parameter controls the rolloff, the window parameter
|
|
* controls rolloff and stopband attenuation. The Hamming window provides a faster rolloff but a bit
|
|
* worse stopband attenuation, the other way around for the Blackman window.
|
|
* </para>
|
|
* <para>
|
|
* This element has the advantage over the Chebyshev bandpass and bandreject filter that it has
|
|
* a much better rolloff when using a larger kernel size and almost linear phase. The only
|
|
* disadvantage is the much slower execution time with larger kernels.
|
|
* </para>
|
|
* <title>Example launch line</title>
|
|
* <para>
|
|
* <programlisting>
|
|
* gst-launch audiotestsrc freq=1500 ! audioconvert ! bpwsinc mode=band-pass lower-frequency=3000 upper-frequency=10000 length=501 window=blackman ! audioconvert ! alsasink
|
|
* gst-launch filesrc location="melo1.ogg" ! oggdemux ! vorbisdec ! audioconvert ! bpwsinc mode=band-reject lower-frequency=59 upper-frequency=61 length=10001 window=hamming ! audioconvert ! alsasink
|
|
* gst-launch audiotestsrc wave=white-noise ! audioconvert ! bpwsinc mode=band-pass lower-frequency=1000 upper-frequency=2000 length=31 ! audioconvert ! alsasink
|
|
* </programlisting>
|
|
* </para>
|
|
* </refsect2>
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include <string.h>
|
|
#include <math.h>
|
|
#include <gst/gst.h>
|
|
#include <gst/audio/gstaudiofilter.h>
|
|
#include <gst/controller/gstcontroller.h>
|
|
|
|
#include "gstbpwsinc.h"
|
|
|
|
#define GST_CAT_DEFAULT gst_bpwsinc_debug
|
|
GST_DEBUG_CATEGORY_STATIC (GST_CAT_DEFAULT);
|
|
|
|
static const GstElementDetails bpwsinc_details =
|
|
GST_ELEMENT_DETAILS ("Band-pass and Band-reject Windowed sinc filter",
|
|
"Filter/Effect/Audio",
|
|
"Band-pass Windowed sinc filter",
|
|
"Thomas <thomas@apestaart.org>, "
|
|
"Steven W. Smith, "
|
|
"Dreamlab Technologies Ltd. <mathis.hofer@dreamlab.net>, "
|
|
"Sebastian Dröge <slomo@circular-chaos.org>");
|
|
|
|
/* Filter signals and args */
|
|
enum
|
|
{
|
|
/* FILL ME */
|
|
LAST_SIGNAL
|
|
};
|
|
|
|
enum
|
|
{
|
|
PROP_0,
|
|
PROP_LENGTH,
|
|
PROP_LOWER_FREQUENCY,
|
|
PROP_UPPER_FREQUENCY,
|
|
PROP_MODE,
|
|
PROP_WINDOW
|
|
};
|
|
|
|
enum
|
|
{
|
|
MODE_BAND_PASS = 0,
|
|
MODE_BAND_REJECT
|
|
};
|
|
|
|
#define GST_TYPE_BPWSINC_MODE (gst_bpwsinc_mode_get_type ())
|
|
static GType
|
|
gst_bpwsinc_mode_get_type (void)
|
|
{
|
|
static GType gtype = 0;
|
|
|
|
if (gtype == 0) {
|
|
static const GEnumValue values[] = {
|
|
{MODE_BAND_PASS, "Band pass (default)",
|
|
"band-pass"},
|
|
{MODE_BAND_REJECT, "Band reject",
|
|
"band-reject"},
|
|
{0, NULL, NULL}
|
|
};
|
|
|
|
gtype = g_enum_register_static ("GstBPWSincMode", values);
|
|
}
|
|
return gtype;
|
|
}
|
|
|
|
enum
|
|
{
|
|
WINDOW_HAMMING = 0,
|
|
WINDOW_BLACKMAN
|
|
};
|
|
|
|
#define GST_TYPE_BPWSINC_WINDOW (gst_bpwsinc_window_get_type ())
|
|
static GType
|
|
gst_bpwsinc_window_get_type (void)
|
|
{
|
|
static GType gtype = 0;
|
|
|
|
if (gtype == 0) {
|
|
static const GEnumValue values[] = {
|
|
{WINDOW_HAMMING, "Hamming window (default)",
|
|
"hamming"},
|
|
{WINDOW_BLACKMAN, "Blackman window",
|
|
"blackman"},
|
|
{0, NULL, NULL}
|
|
};
|
|
|
|
gtype = g_enum_register_static ("GstBPWSincWindow", values);
|
|
}
|
|
return gtype;
|
|
}
|
|
|
|
#define ALLOWED_CAPS \
|
|
"audio/x-raw-float, " \
|
|
" width = (int) { 32, 64 }, " \
|
|
" endianness = (int) BYTE_ORDER, " \
|
|
" rate = (int) [ 1, MAX ], " \
|
|
" channels = (int) [ 1, MAX ] "
|
|
|
|
#define DEBUG_INIT(bla) \
|
|
GST_DEBUG_CATEGORY_INIT (gst_bpwsinc_debug, "bpwsinc", 0, "Band-pass and Band-reject Windowed sinc filter plugin");
|
|
|
|
GST_BOILERPLATE_FULL (GstBPWSinc, gst_bpwsinc, GstAudioFilter,
|
|
GST_TYPE_AUDIO_FILTER, DEBUG_INIT);
|
|
|
|
static void bpwsinc_set_property (GObject * object, guint prop_id,
|
|
const GValue * value, GParamSpec * pspec);
|
|
static void bpwsinc_get_property (GObject * object, guint prop_id,
|
|
GValue * value, GParamSpec * pspec);
|
|
|
|
static GstFlowReturn bpwsinc_transform (GstBaseTransform * base,
|
|
GstBuffer * inbuf, GstBuffer * outbuf);
|
|
static gboolean bpwsinc_get_unit_size (GstBaseTransform * base, GstCaps * caps,
|
|
guint * size);
|
|
static gboolean bpwsinc_start (GstBaseTransform * base);
|
|
static gboolean bpwsinc_event (GstBaseTransform * base, GstEvent * event);
|
|
|
|
static gboolean bpwsinc_setup (GstAudioFilter * base,
|
|
GstRingBufferSpec * format);
|
|
|
|
static gboolean bpwsinc_query (GstPad * pad, GstQuery * query);
|
|
static const GstQueryType *bpwsinc_query_type (GstPad * pad);
|
|
|
|
/* Element class */
|
|
|
|
static void
|
|
gst_bpwsinc_dispose (GObject * object)
|
|
{
|
|
GstBPWSinc *self = GST_BPWSINC (object);
|
|
|
|
if (self->residue) {
|
|
g_free (self->residue);
|
|
self->residue = NULL;
|
|
}
|
|
|
|
if (self->kernel) {
|
|
g_free (self->kernel);
|
|
self->kernel = NULL;
|
|
}
|
|
|
|
G_OBJECT_CLASS (parent_class)->dispose (object);
|
|
}
|
|
|
|
static void
|
|
gst_bpwsinc_base_init (gpointer g_class)
|
|
{
|
|
GstElementClass *element_class = GST_ELEMENT_CLASS (g_class);
|
|
GstCaps *caps;
|
|
|
|
gst_element_class_set_details (element_class, &bpwsinc_details);
|
|
|
|
caps = gst_caps_from_string (ALLOWED_CAPS);
|
|
gst_audio_filter_class_add_pad_templates (GST_AUDIO_FILTER_CLASS (g_class),
|
|
caps);
|
|
gst_caps_unref (caps);
|
|
}
|
|
|
|
static void
|
|
gst_bpwsinc_class_init (GstBPWSincClass * klass)
|
|
{
|
|
GObjectClass *gobject_class;
|
|
GstBaseTransformClass *trans_class;
|
|
GstAudioFilterClass *filter_class;
|
|
|
|
gobject_class = (GObjectClass *) klass;
|
|
trans_class = (GstBaseTransformClass *) klass;
|
|
filter_class = (GstAudioFilterClass *) klass;
|
|
|
|
gobject_class->set_property = bpwsinc_set_property;
|
|
gobject_class->get_property = bpwsinc_get_property;
|
|
gobject_class->dispose = gst_bpwsinc_dispose;
|
|
|
|
/* FIXME: Don't use the complete possible range but restrict the upper boundary
|
|
* so automatically generated UIs can use a slider */
|
|
g_object_class_install_property (gobject_class, PROP_LOWER_FREQUENCY,
|
|
g_param_spec_float ("lower-frequency", "Lower Frequency",
|
|
"Cut-off lower frequency (Hz)", 0.0, 100000.0, 0, G_PARAM_READWRITE));
|
|
g_object_class_install_property (gobject_class, PROP_UPPER_FREQUENCY,
|
|
g_param_spec_float ("upper-frequency", "Upper Frequency",
|
|
"Cut-off upper frequency (Hz)", 0.0, 100000.0, 0, G_PARAM_READWRITE));
|
|
g_object_class_install_property (gobject_class, PROP_LENGTH,
|
|
g_param_spec_int ("length", "Length",
|
|
"Filter kernel length, will be rounded to the next odd number",
|
|
3, 50000, 101, G_PARAM_READWRITE));
|
|
|
|
g_object_class_install_property (gobject_class, PROP_MODE,
|
|
g_param_spec_enum ("mode", "Mode",
|
|
"Band pass or band reject mode", GST_TYPE_BPWSINC_MODE,
|
|
MODE_BAND_PASS, G_PARAM_READWRITE | GST_PARAM_CONTROLLABLE));
|
|
|
|
g_object_class_install_property (gobject_class, PROP_WINDOW,
|
|
g_param_spec_enum ("window", "Window",
|
|
"Window function to use", GST_TYPE_BPWSINC_WINDOW,
|
|
WINDOW_HAMMING, G_PARAM_READWRITE | GST_PARAM_CONTROLLABLE));
|
|
|
|
trans_class->transform = GST_DEBUG_FUNCPTR (bpwsinc_transform);
|
|
trans_class->get_unit_size = GST_DEBUG_FUNCPTR (bpwsinc_get_unit_size);
|
|
trans_class->start = GST_DEBUG_FUNCPTR (bpwsinc_start);
|
|
trans_class->event = GST_DEBUG_FUNCPTR (bpwsinc_event);
|
|
filter_class->setup = GST_DEBUG_FUNCPTR (bpwsinc_setup);
|
|
}
|
|
|
|
static void
|
|
gst_bpwsinc_init (GstBPWSinc * self, GstBPWSincClass * g_class)
|
|
{
|
|
self->kernel_length = 101;
|
|
self->latency = 50;
|
|
self->lower_frequency = 0.0;
|
|
self->upper_frequency = 0.0;
|
|
self->mode = MODE_BAND_PASS;
|
|
self->window = WINDOW_HAMMING;
|
|
self->kernel = NULL;
|
|
self->have_kernel = FALSE;
|
|
self->residue = NULL;
|
|
|
|
self->residue_length = 0;
|
|
self->next_ts = GST_CLOCK_TIME_NONE;
|
|
self->next_off = GST_BUFFER_OFFSET_NONE;
|
|
|
|
gst_pad_set_query_function (GST_BASE_TRANSFORM (self)->srcpad, bpwsinc_query);
|
|
gst_pad_set_query_type_function (GST_BASE_TRANSFORM (self)->srcpad,
|
|
bpwsinc_query_type);
|
|
}
|
|
|
|
#define DEFINE_PROCESS_FUNC(width,ctype) \
|
|
static void \
|
|
process_##width (GstBPWSinc * self, g##ctype * src, g##ctype * dst, guint input_samples) \
|
|
{ \
|
|
gint kernel_length = self->kernel_length; \
|
|
gint i, j, k, l; \
|
|
gint channels = GST_AUDIO_FILTER (self)->format.channels; \
|
|
gint res_start; \
|
|
\
|
|
/* convolution */ \
|
|
for (i = 0; i < input_samples; i++) { \
|
|
dst[i] = 0.0; \
|
|
k = i % channels; \
|
|
l = i / channels; \
|
|
for (j = 0; j < kernel_length; j++) \
|
|
if (l < j) \
|
|
dst[i] += \
|
|
self->residue[(kernel_length + l - j) * channels + \
|
|
k] * self->kernel[j]; \
|
|
else \
|
|
dst[i] += src[(l - j) * channels + k] * self->kernel[j]; \
|
|
} \
|
|
\
|
|
/* copy the tail of the current input buffer to the residue, while \
|
|
* keeping parts of the residue if the input buffer is smaller than \
|
|
* the kernel length */ \
|
|
if (input_samples < kernel_length * channels) \
|
|
res_start = kernel_length * channels - input_samples; \
|
|
else \
|
|
res_start = 0; \
|
|
\
|
|
for (i = 0; i < res_start; i++) \
|
|
self->residue[i] = self->residue[i + input_samples]; \
|
|
for (i = res_start; i < kernel_length * channels; i++) \
|
|
self->residue[i] = src[input_samples - kernel_length * channels + i]; \
|
|
\
|
|
self->residue_length += kernel_length * channels - res_start; \
|
|
if (self->residue_length > kernel_length * channels) \
|
|
self->residue_length = kernel_length * channels; \
|
|
}
|
|
|
|
DEFINE_PROCESS_FUNC (32, float);
|
|
DEFINE_PROCESS_FUNC (64, double);
|
|
|
|
#undef DEFINE_PROCESS_FUNC
|
|
|
|
static void
|
|
bpwsinc_build_kernel (GstBPWSinc * self)
|
|
{
|
|
gint i = 0;
|
|
gdouble sum = 0.0;
|
|
gint len = 0;
|
|
gdouble *kernel_lp, *kernel_hp;
|
|
gdouble w;
|
|
|
|
len = self->kernel_length;
|
|
|
|
if (GST_AUDIO_FILTER (self)->format.rate == 0) {
|
|
GST_DEBUG ("rate not set yet");
|
|
return;
|
|
}
|
|
|
|
if (GST_AUDIO_FILTER (self)->format.channels == 0) {
|
|
GST_DEBUG ("channels not set yet");
|
|
return;
|
|
}
|
|
|
|
/* Clamp frequencies */
|
|
self->lower_frequency =
|
|
CLAMP (self->lower_frequency, 0.0,
|
|
GST_AUDIO_FILTER (self)->format.rate / 2);
|
|
self->upper_frequency =
|
|
CLAMP (self->upper_frequency, 0.0,
|
|
GST_AUDIO_FILTER (self)->format.rate / 2);
|
|
if (self->lower_frequency > self->upper_frequency) {
|
|
gint tmp = self->lower_frequency;
|
|
|
|
self->lower_frequency = self->upper_frequency;
|
|
self->upper_frequency = tmp;
|
|
}
|
|
|
|
GST_DEBUG ("bpwsinc: initializing filter kernel of length %d "
|
|
"with lower frequency %.2lf Hz "
|
|
", upper frequency %.2lf Hz for mode %s",
|
|
len, self->lower_frequency, self->upper_frequency,
|
|
(self->mode == MODE_BAND_PASS) ? "band-pass" : "band-reject");
|
|
|
|
/* fill the lp kernel */
|
|
w = 2 * M_PI * (self->lower_frequency / GST_AUDIO_FILTER (self)->format.rate);
|
|
kernel_lp = g_new (gdouble, len);
|
|
for (i = 0; i < len; ++i) {
|
|
if (i == len / 2)
|
|
kernel_lp[i] = w;
|
|
else
|
|
kernel_lp[i] = sin (w * (i - len / 2))
|
|
/ (i - len / 2);
|
|
/* Windowing */
|
|
if (self->window == WINDOW_HAMMING)
|
|
kernel_lp[i] *= (0.54 - 0.46 * cos (2 * M_PI * i / len));
|
|
else
|
|
kernel_lp[i] *=
|
|
(0.42 - 0.5 * cos (2 * M_PI * i / len) +
|
|
0.08 * cos (4 * M_PI * i / len));
|
|
}
|
|
|
|
/* normalize for unity gain at DC */
|
|
sum = 0.0;
|
|
for (i = 0; i < len; ++i)
|
|
sum += kernel_lp[i];
|
|
for (i = 0; i < len; ++i)
|
|
kernel_lp[i] /= sum;
|
|
|
|
/* fill the hp kernel */
|
|
w = 2 * M_PI * (self->upper_frequency / GST_AUDIO_FILTER (self)->format.rate);
|
|
kernel_hp = g_new (gdouble, len);
|
|
for (i = 0; i < len; ++i) {
|
|
if (i == len / 2)
|
|
kernel_hp[i] = w;
|
|
else
|
|
kernel_hp[i] = sin (w * (i - len / 2))
|
|
/ (i - len / 2);
|
|
/* Windowing */
|
|
if (self->window == WINDOW_HAMMING)
|
|
kernel_hp[i] *= (0.54 - 0.46 * cos (2 * M_PI * i / len));
|
|
else
|
|
kernel_hp[i] *=
|
|
(0.42 - 0.5 * cos (2 * M_PI * i / len) +
|
|
0.08 * cos (4 * M_PI * i / len));
|
|
}
|
|
|
|
/* normalize for unity gain at DC */
|
|
sum = 0.0;
|
|
for (i = 0; i < len; ++i)
|
|
sum += kernel_hp[i];
|
|
for (i = 0; i < len; ++i)
|
|
kernel_hp[i] /= sum;
|
|
|
|
/* do spectral inversion to go from lowpass to highpass */
|
|
for (i = 0; i < len; ++i)
|
|
kernel_hp[i] = -kernel_hp[i];
|
|
kernel_hp[len / 2] += 1;
|
|
|
|
/* combine the two kernels */
|
|
if (self->kernel)
|
|
g_free (self->kernel);
|
|
self->kernel = g_new (gdouble, len);
|
|
|
|
for (i = 0; i < len; ++i)
|
|
self->kernel[i] = kernel_lp[i] + kernel_hp[i];
|
|
|
|
/* free the helper kernels */
|
|
g_free (kernel_lp);
|
|
g_free (kernel_hp);
|
|
|
|
/* do spectral inversion to go from bandreject to bandpass
|
|
* if specified */
|
|
if (self->mode == MODE_BAND_PASS) {
|
|
for (i = 0; i < len; ++i)
|
|
self->kernel[i] = -self->kernel[i];
|
|
self->kernel[len / 2] += 1;
|
|
}
|
|
|
|
/* set up the residue memory space */
|
|
if (!self->residue) {
|
|
self->residue =
|
|
g_new0 (gdouble, len * GST_AUDIO_FILTER (self)->format.channels);
|
|
self->residue_length = 0;
|
|
}
|
|
|
|
self->have_kernel = TRUE;
|
|
}
|
|
|
|
static void
|
|
bpwsinc_push_residue (GstBPWSinc * self)
|
|
{
|
|
GstBuffer *outbuf;
|
|
GstFlowReturn res;
|
|
gint rate = GST_AUDIO_FILTER (self)->format.rate;
|
|
gint channels = GST_AUDIO_FILTER (self)->format.channels;
|
|
gint outsize, outsamples;
|
|
gint diffsize, diffsamples;
|
|
guint8 *in, *out;
|
|
|
|
/* Calculate the number of samples and their memory size that
|
|
* should be pushed from the residue */
|
|
outsamples = MIN (self->latency, self->residue_length / channels);
|
|
outsize = outsamples * channels * (GST_AUDIO_FILTER (self)->format.width / 8);
|
|
if (outsize == 0)
|
|
return;
|
|
|
|
/* Process the difference between latency and residue_length samples
|
|
* to start at the actual data instead of starting at the zeros before
|
|
* when we only got one buffer smaller than latency */
|
|
diffsamples = self->latency - self->residue_length / channels;
|
|
diffsize =
|
|
diffsamples * channels * (GST_AUDIO_FILTER (self)->format.width / 8);
|
|
if (diffsize > 0) {
|
|
in = g_new0 (guint8, diffsize);
|
|
out = g_new0 (guint8, diffsize);
|
|
self->process (self, in, out, diffsamples * channels);
|
|
g_free (in);
|
|
g_free (out);
|
|
}
|
|
|
|
res = gst_pad_alloc_buffer (GST_BASE_TRANSFORM (self)->srcpad,
|
|
GST_BUFFER_OFFSET_NONE, outsize,
|
|
GST_PAD_CAPS (GST_BASE_TRANSFORM (self)->srcpad), &outbuf);
|
|
|
|
if (G_UNLIKELY (res != GST_FLOW_OK)) {
|
|
GST_WARNING_OBJECT (self, "failed allocating buffer of %d bytes", outsize);
|
|
return;
|
|
}
|
|
|
|
/* Convolve the residue with zeros to get the actual remaining data */
|
|
in = g_new0 (guint8, outsize);
|
|
self->process (self, in, GST_BUFFER_DATA (outbuf), outsamples * channels);
|
|
g_free (in);
|
|
|
|
/* Set timestamp, offset, etc from the values we
|
|
* saved when processing the regular buffers */
|
|
if (GST_CLOCK_TIME_IS_VALID (self->next_ts))
|
|
GST_BUFFER_TIMESTAMP (outbuf) = self->next_ts;
|
|
else
|
|
GST_BUFFER_TIMESTAMP (outbuf) = 0;
|
|
GST_BUFFER_DURATION (outbuf) =
|
|
gst_util_uint64_scale (outsamples, GST_SECOND, rate);
|
|
self->next_ts += gst_util_uint64_scale (outsamples, GST_SECOND, rate);
|
|
|
|
if (self->next_off != GST_BUFFER_OFFSET_NONE) {
|
|
GST_BUFFER_OFFSET (outbuf) = self->next_off;
|
|
GST_BUFFER_OFFSET_END (outbuf) = self->next_off + outsamples;
|
|
}
|
|
|
|
GST_DEBUG_OBJECT (self, "Pushing residue buffer of size %d with timestamp: %"
|
|
GST_TIME_FORMAT ", duration: %" GST_TIME_FORMAT ", offset: %lld,"
|
|
" offset_end: %lld, nsamples: %d", GST_BUFFER_SIZE (outbuf),
|
|
GST_TIME_ARGS (GST_BUFFER_TIMESTAMP (outbuf)),
|
|
GST_TIME_ARGS (GST_BUFFER_DURATION (outbuf)), GST_BUFFER_OFFSET (outbuf),
|
|
GST_BUFFER_OFFSET_END (outbuf), outsamples);
|
|
|
|
res = gst_pad_push (GST_BASE_TRANSFORM (self)->srcpad, outbuf);
|
|
|
|
if (G_UNLIKELY (res != GST_FLOW_OK)) {
|
|
GST_WARNING_OBJECT (self, "failed to push residue");
|
|
}
|
|
|
|
}
|
|
|
|
/* GstAudioFilter vmethod implementations */
|
|
|
|
/* get notified of caps and plug in the correct process function */
|
|
static gboolean
|
|
bpwsinc_setup (GstAudioFilter * base, GstRingBufferSpec * format)
|
|
{
|
|
GstBPWSinc *self = GST_BPWSINC (base);
|
|
|
|
gboolean ret = TRUE;
|
|
|
|
if (format->width == 32)
|
|
self->process = (GstBPWSincProcessFunc) process_32;
|
|
else if (format->width == 64)
|
|
self->process = (GstBPWSincProcessFunc) process_64;
|
|
else
|
|
ret = FALSE;
|
|
|
|
self->have_kernel = FALSE;
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
/* GstBaseTransform vmethod implementations */
|
|
|
|
static gboolean
|
|
bpwsinc_get_unit_size (GstBaseTransform * base, GstCaps * caps, guint * size)
|
|
{
|
|
gint width, channels;
|
|
GstStructure *structure;
|
|
gboolean ret;
|
|
|
|
g_assert (size);
|
|
|
|
structure = gst_caps_get_structure (caps, 0);
|
|
ret = gst_structure_get_int (structure, "width", &width);
|
|
ret &= gst_structure_get_int (structure, "channels", &channels);
|
|
|
|
*size = width * channels / 8;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static GstFlowReturn
|
|
bpwsinc_transform (GstBaseTransform * base, GstBuffer * inbuf,
|
|
GstBuffer * outbuf)
|
|
{
|
|
GstBPWSinc *self = GST_BPWSINC (base);
|
|
GstClockTime timestamp;
|
|
gint channels = GST_AUDIO_FILTER (self)->format.channels;
|
|
gint rate = GST_AUDIO_FILTER (self)->format.rate;
|
|
gint input_samples =
|
|
GST_BUFFER_SIZE (outbuf) / (GST_AUDIO_FILTER (self)->format.width / 8);
|
|
gint output_samples = input_samples;
|
|
gint diff;
|
|
|
|
/* FIXME: subdivide GST_BUFFER_SIZE into small chunks for smooth fades */
|
|
timestamp = GST_BUFFER_TIMESTAMP (outbuf);
|
|
if (GST_CLOCK_TIME_IS_VALID (timestamp))
|
|
gst_object_sync_values (G_OBJECT (self), timestamp);
|
|
|
|
if (!self->have_kernel)
|
|
bpwsinc_build_kernel (self);
|
|
|
|
/* Reset the residue if already existing on discont buffers */
|
|
if (GST_BUFFER_IS_DISCONT (inbuf)) {
|
|
if (channels && self->residue)
|
|
memset (self->residue, 0, channels *
|
|
self->kernel_length * sizeof (gdouble));
|
|
self->residue_length = 0;
|
|
self->next_ts = GST_CLOCK_TIME_NONE;
|
|
self->next_off = GST_BUFFER_OFFSET_NONE;
|
|
}
|
|
|
|
/* Calculate the number of samples we can push out now without outputting
|
|
* kernel_length/2 zeros in the beginning */
|
|
diff = (self->kernel_length / 2) * channels - self->residue_length;
|
|
if (diff > 0)
|
|
output_samples -= diff;
|
|
|
|
self->process (self, GST_BUFFER_DATA (inbuf), GST_BUFFER_DATA (outbuf),
|
|
input_samples);
|
|
|
|
if (output_samples <= 0) {
|
|
/* Drop buffer and save original timestamp/offset for later use */
|
|
if (!GST_CLOCK_TIME_IS_VALID (self->next_ts)
|
|
&& GST_BUFFER_TIMESTAMP_IS_VALID (outbuf))
|
|
self->next_ts = GST_BUFFER_TIMESTAMP (outbuf);
|
|
if (self->next_off == GST_BUFFER_OFFSET_NONE
|
|
&& GST_BUFFER_OFFSET_IS_VALID (outbuf))
|
|
self->next_off = GST_BUFFER_OFFSET (outbuf);
|
|
return GST_BASE_TRANSFORM_FLOW_DROPPED;
|
|
} else if (output_samples < input_samples) {
|
|
/* First (probably partial) buffer after starting from
|
|
* a clean residue. Use stored timestamp/offset here */
|
|
if (GST_CLOCK_TIME_IS_VALID (self->next_ts))
|
|
GST_BUFFER_TIMESTAMP (outbuf) = self->next_ts;
|
|
|
|
if (self->next_off != GST_BUFFER_OFFSET_NONE) {
|
|
GST_BUFFER_OFFSET (outbuf) = self->next_off;
|
|
if (GST_BUFFER_OFFSET_END_IS_VALID (outbuf))
|
|
GST_BUFFER_OFFSET_END (outbuf) =
|
|
self->next_off + output_samples / channels;
|
|
} else {
|
|
/* We dropped no buffer, offset is valid, offset_end must be adjusted by diff */
|
|
if (GST_BUFFER_OFFSET_END_IS_VALID (outbuf))
|
|
GST_BUFFER_OFFSET_END (outbuf) -= diff / channels;
|
|
}
|
|
|
|
if (GST_BUFFER_DURATION_IS_VALID (outbuf))
|
|
GST_BUFFER_DURATION (outbuf) -=
|
|
gst_util_uint64_scale (diff, GST_SECOND, channels * rate);
|
|
|
|
GST_BUFFER_DATA (outbuf) +=
|
|
diff * (GST_AUDIO_FILTER (self)->format.width / 8);
|
|
GST_BUFFER_SIZE (outbuf) -=
|
|
diff * (GST_AUDIO_FILTER (self)->format.width / 8);
|
|
} else {
|
|
GstClockTime ts_latency =
|
|
gst_util_uint64_scale (self->latency, GST_SECOND, rate);
|
|
|
|
/* Normal buffer, adjust timestamp/offset/etc by latency */
|
|
if (GST_BUFFER_TIMESTAMP (outbuf) < ts_latency) {
|
|
GST_WARNING_OBJECT (self, "GST_BUFFER_TIMESTAMP (outbuf) < latency");
|
|
GST_BUFFER_TIMESTAMP (outbuf) = 0;
|
|
} else {
|
|
GST_BUFFER_TIMESTAMP (outbuf) -= ts_latency;
|
|
}
|
|
|
|
if (GST_BUFFER_OFFSET_IS_VALID (outbuf)) {
|
|
if (GST_BUFFER_OFFSET (outbuf) > self->latency) {
|
|
GST_BUFFER_OFFSET (outbuf) -= self->latency;
|
|
} else {
|
|
GST_WARNING_OBJECT (self, "GST_BUFFER_OFFSET (outbuf) < latency");
|
|
GST_BUFFER_OFFSET (outbuf) = 0;
|
|
}
|
|
}
|
|
|
|
if (GST_BUFFER_OFFSET_END_IS_VALID (outbuf)) {
|
|
if (GST_BUFFER_OFFSET_END (outbuf) > self->latency) {
|
|
GST_BUFFER_OFFSET_END (outbuf) -= self->latency;
|
|
} else {
|
|
GST_WARNING_OBJECT (self, "GST_BUFFER_OFFSET_END (outbuf) < latency");
|
|
GST_BUFFER_OFFSET_END (outbuf) = 0;
|
|
}
|
|
}
|
|
}
|
|
|
|
GST_DEBUG_OBJECT (self, "Pushing buffer of size %d with timestamp: %"
|
|
GST_TIME_FORMAT ", duration: %" GST_TIME_FORMAT ", offset: %lld,"
|
|
" offset_end: %lld, nsamples: %d", GST_BUFFER_SIZE (outbuf),
|
|
GST_TIME_ARGS (GST_BUFFER_TIMESTAMP (outbuf)),
|
|
GST_TIME_ARGS (GST_BUFFER_DURATION (outbuf)), GST_BUFFER_OFFSET (outbuf),
|
|
GST_BUFFER_OFFSET_END (outbuf), output_samples / channels);
|
|
|
|
self->next_ts = GST_BUFFER_TIMESTAMP (outbuf) + GST_BUFFER_DURATION (outbuf);
|
|
self->next_off = GST_BUFFER_OFFSET_END (outbuf);
|
|
|
|
return GST_FLOW_OK;
|
|
}
|
|
|
|
static gboolean
|
|
bpwsinc_start (GstBaseTransform * base)
|
|
{
|
|
GstBPWSinc *self = GST_BPWSINC (base);
|
|
gint channels = GST_AUDIO_FILTER (self)->format.channels;
|
|
|
|
/* Reset the residue if already existing */
|
|
if (channels && self->residue)
|
|
memset (self->residue, 0, channels *
|
|
self->kernel_length * sizeof (gdouble));
|
|
|
|
self->residue_length = 0;
|
|
self->next_ts = GST_CLOCK_TIME_NONE;
|
|
self->next_off = GST_BUFFER_OFFSET_NONE;
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
static gboolean
|
|
bpwsinc_query (GstPad * pad, GstQuery * query)
|
|
{
|
|
GstBPWSinc *self = GST_BPWSINC (gst_pad_get_parent (pad));
|
|
gboolean res = TRUE;
|
|
|
|
switch (GST_QUERY_TYPE (query)) {
|
|
case GST_QUERY_LATENCY:
|
|
{
|
|
GstClockTime min, max;
|
|
gboolean live;
|
|
guint64 latency;
|
|
GstPad *peer;
|
|
gint rate = GST_AUDIO_FILTER (self)->format.rate;
|
|
|
|
if ((peer = gst_pad_get_peer (GST_BASE_TRANSFORM (self)->sinkpad))) {
|
|
if ((res = gst_pad_query (peer, query))) {
|
|
gst_query_parse_latency (query, &live, &min, &max);
|
|
|
|
GST_DEBUG_OBJECT (self, "Peer latency: min %"
|
|
GST_TIME_FORMAT " max %" GST_TIME_FORMAT,
|
|
GST_TIME_ARGS (min), GST_TIME_ARGS (max));
|
|
|
|
/* add our own latency */
|
|
latency =
|
|
(rate != 0) ? gst_util_uint64_scale (self->latency, GST_SECOND,
|
|
rate) : 0;
|
|
|
|
GST_DEBUG_OBJECT (self, "Our latency: %"
|
|
GST_TIME_FORMAT, GST_TIME_ARGS (latency));
|
|
|
|
min += latency;
|
|
if (max != GST_CLOCK_TIME_NONE)
|
|
max += latency;
|
|
|
|
GST_DEBUG_OBJECT (self, "Calculated total latency : min %"
|
|
GST_TIME_FORMAT " max %" GST_TIME_FORMAT,
|
|
GST_TIME_ARGS (min), GST_TIME_ARGS (max));
|
|
|
|
gst_query_set_latency (query, live, min, max);
|
|
}
|
|
gst_object_unref (peer);
|
|
}
|
|
break;
|
|
}
|
|
default:
|
|
res = gst_pad_query_default (pad, query);
|
|
break;
|
|
}
|
|
gst_object_unref (self);
|
|
return res;
|
|
}
|
|
|
|
static const GstQueryType *
|
|
bpwsinc_query_type (GstPad * pad)
|
|
{
|
|
static const GstQueryType types[] = {
|
|
GST_QUERY_LATENCY,
|
|
0
|
|
};
|
|
|
|
return types;
|
|
}
|
|
|
|
static gboolean
|
|
bpwsinc_event (GstBaseTransform * base, GstEvent * event)
|
|
{
|
|
GstBPWSinc *self = GST_BPWSINC (base);
|
|
|
|
switch (GST_EVENT_TYPE (event)) {
|
|
case GST_EVENT_EOS:
|
|
bpwsinc_push_residue (self);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return GST_BASE_TRANSFORM_CLASS (parent_class)->event (base, event);
|
|
}
|
|
|
|
static void
|
|
bpwsinc_set_property (GObject * object, guint prop_id, const GValue * value,
|
|
GParamSpec * pspec)
|
|
{
|
|
GstBPWSinc *self = GST_BPWSINC (object);
|
|
|
|
g_return_if_fail (GST_IS_BPWSINC (self));
|
|
|
|
switch (prop_id) {
|
|
case PROP_LENGTH:{
|
|
gint val;
|
|
|
|
GST_BASE_TRANSFORM_LOCK (self);
|
|
val = g_value_get_int (value);
|
|
if (val % 2 == 0)
|
|
val++;
|
|
|
|
if (val != self->kernel_length) {
|
|
if (self->residue) {
|
|
bpwsinc_push_residue (self);
|
|
g_free (self->residue);
|
|
self->residue = NULL;
|
|
}
|
|
self->kernel_length = val;
|
|
self->latency = val / 2;
|
|
bpwsinc_build_kernel (self);
|
|
gst_element_post_message (GST_ELEMENT (self),
|
|
gst_message_new_latency (GST_OBJECT (self)));
|
|
}
|
|
GST_BASE_TRANSFORM_UNLOCK (self);
|
|
break;
|
|
}
|
|
case PROP_LOWER_FREQUENCY:
|
|
GST_BASE_TRANSFORM_LOCK (self);
|
|
self->lower_frequency = g_value_get_float (value);
|
|
bpwsinc_build_kernel (self);
|
|
GST_BASE_TRANSFORM_UNLOCK (self);
|
|
break;
|
|
case PROP_UPPER_FREQUENCY:
|
|
GST_BASE_TRANSFORM_LOCK (self);
|
|
self->upper_frequency = g_value_get_float (value);
|
|
bpwsinc_build_kernel (self);
|
|
GST_BASE_TRANSFORM_UNLOCK (self);
|
|
break;
|
|
case PROP_MODE:
|
|
GST_BASE_TRANSFORM_LOCK (self);
|
|
self->mode = g_value_get_enum (value);
|
|
bpwsinc_build_kernel (self);
|
|
GST_BASE_TRANSFORM_UNLOCK (self);
|
|
break;
|
|
case PROP_WINDOW:
|
|
GST_BASE_TRANSFORM_LOCK (self);
|
|
self->window = g_value_get_enum (value);
|
|
bpwsinc_build_kernel (self);
|
|
GST_BASE_TRANSFORM_UNLOCK (self);
|
|
break;
|
|
default:
|
|
G_OBJECT_WARN_INVALID_PROPERTY_ID (object, prop_id, pspec);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void
|
|
bpwsinc_get_property (GObject * object, guint prop_id, GValue * value,
|
|
GParamSpec * pspec)
|
|
{
|
|
GstBPWSinc *self = GST_BPWSINC (object);
|
|
|
|
switch (prop_id) {
|
|
case PROP_LENGTH:
|
|
g_value_set_int (value, self->kernel_length);
|
|
break;
|
|
case PROP_LOWER_FREQUENCY:
|
|
g_value_set_float (value, self->lower_frequency);
|
|
break;
|
|
case PROP_UPPER_FREQUENCY:
|
|
g_value_set_float (value, self->upper_frequency);
|
|
break;
|
|
case PROP_MODE:
|
|
g_value_set_enum (value, self->mode);
|
|
break;
|
|
case PROP_WINDOW:
|
|
g_value_set_enum (value, self->window);
|
|
break;
|
|
default:
|
|
G_OBJECT_WARN_INVALID_PROPERTY_ID (object, prop_id, pspec);
|
|
break;
|
|
}
|
|
}
|