/*
+ * Copyright (c) 2005 Boðaç Topaktaþ
+ * Copyright (c) 2020 Paul B Mahol
+ *
* This file is part of FFmpeg.
*
* FFmpeg is free software; you can redistribute it and/or
const AVClass *class;
double cutoff;
+ double level;
+ double qfactor;
int order;
int filter_count;
if (s->bypass)
return 0;
- s->filter_count = s->order / 2 + (s->order & 1);
- calc_q_factors(s->order, q);
+ if (!strcmp(ctx->filter->name, "asubcut")) {
+ s->filter_count = s->order / 2 + (s->order & 1);
- if (s->order & 1) {
- BiquadCoeffs *coeffs = &s->coeffs[0];
- double omega = 2. * tan(M_PI * w0);
+ calc_q_factors(s->order, q);
- coeffs->b0 = omega / (2. + omega);
- coeffs->b1 = coeffs->b0;
- coeffs->b2 = 0.;
- coeffs->a1 = -(omega - 2.) / (2. + omega);
- coeffs->a2 = 0.;
- }
+ if (s->order & 1) {
+ BiquadCoeffs *coeffs = &s->coeffs[0];
+ double omega = 2. * tan(M_PI * w0);
+
+ coeffs->b0 = 2. / (2. + omega);
+ coeffs->b1 = -coeffs->b0;
+ coeffs->b2 = 0.;
+ coeffs->a1 = -(omega - 2.) / (2. + omega);
+ coeffs->a2 = 0.;
+ }
+
+ for (int b = (s->order & 1); b < s->filter_count; b++) {
+ BiquadCoeffs *coeffs = &s->coeffs[b];
+ const int idx = b - (s->order & 1);
+ double norm = 1.0 / (1.0 + K / q[idx] + K * K);
+
+ coeffs->b0 = norm;
+ coeffs->b1 = -2.0 * coeffs->b0;
+ coeffs->b2 = coeffs->b0;
+ coeffs->a1 = -2.0 * (K * K - 1.0) * norm;
+ coeffs->a2 = -(1.0 - K / q[idx] + K * K) * norm;
+ }
+ } else if (!strcmp(ctx->filter->name, "asupercut")) {
+ s->filter_count = s->order / 2 + (s->order & 1);
- for (int b = (s->order & 1); b < s->filter_count; b++) {
- BiquadCoeffs *coeffs = &s->coeffs[b];
- const int idx = b - (s->order & 1);
- double norm = 1.0 / (1.0 + K / q[idx] + K * K);
+ calc_q_factors(s->order, q);
- coeffs->b0 = K * K * norm;
- coeffs->b1 = 2.0 * coeffs->b0;
- coeffs->b2 = coeffs->b0;
- coeffs->a1 = -2.0 * (K * K - 1.0) * norm;
- coeffs->a2 = -(1.0 - K / q[idx] + K * K) * norm;
+ if (s->order & 1) {
+ BiquadCoeffs *coeffs = &s->coeffs[0];
+ double omega = 2. * tan(M_PI * w0);
+
+ coeffs->b0 = omega / (2. + omega);
+ coeffs->b1 = coeffs->b0;
+ coeffs->b2 = 0.;
+ coeffs->a1 = -(omega - 2.) / (2. + omega);
+ coeffs->a2 = 0.;
+ }
+
+ for (int b = (s->order & 1); b < s->filter_count; b++) {
+ BiquadCoeffs *coeffs = &s->coeffs[b];
+ const int idx = b - (s->order & 1);
+ double norm = 1.0 / (1.0 + K / q[idx] + K * K);
+
+ coeffs->b0 = K * K * norm;
+ coeffs->b1 = 2.0 * coeffs->b0;
+ coeffs->b2 = coeffs->b0;
+ coeffs->a1 = -2.0 * (K * K - 1.0) * norm;
+ coeffs->a2 = -(1.0 - K / q[idx] + K * K) * norm;
+ }
+ } else if (!strcmp(ctx->filter->name, "asuperpass")) {
+ double alpha, beta, gamma, theta;
+ double theta_0 = 2. * M_PI * (s->cutoff / inlink->sample_rate);
+ double d_E;
+
+ s->filter_count = s->order / 2;
+ d_E = (2. * tan(theta_0 / (2. * s->qfactor))) / sin(theta_0);
+
+ for (int b = 0; b < s->filter_count; b += 2) {
+ double D = 2. * sin(((b + 1) * M_PI) / (2. * s->filter_count));
+ double A = (1. + pow((d_E / 2.), 2)) / (D * d_E / 2.);
+ double d = sqrt((d_E * D) / (A + sqrt(A * A - 1.)));
+ double B = D * (d_E / 2.) / d;
+ double W = B + sqrt(B * B - 1.);
+
+ for (int j = 0; j < 2; j++) {
+ BiquadCoeffs *coeffs = &s->coeffs[b + j];
+
+ if (j == 1)
+ theta = 2. * atan(tan(theta_0 / 2.) / W);
+ else
+ theta = 2. * atan(W * tan(theta_0 / 2.));
+
+ beta = 0.5 * ((1. - (d / 2.) * sin(theta)) / (1. + (d / 2.) * sin(theta)));
+ gamma = (0.5 + beta) * cos(theta);
+ alpha = 0.5 * (0.5 - beta) * sqrt(1. + pow((W - (1. / W)) / d, 2.));
+
+ coeffs->a1 = 2. * gamma;
+ coeffs->a2 = -2. * beta;
+ coeffs->b0 = 2. * alpha;
+ coeffs->b1 = 0.;
+ coeffs->b2 = -2. * alpha;
+ }
+ }
+ } else if (!strcmp(ctx->filter->name, "asuperstop")) {
+ double alpha, beta, gamma, theta;
+ double theta_0 = 2. * M_PI * (s->cutoff / inlink->sample_rate);
+ double d_E;
+
+ s->filter_count = s->order / 2;
+ d_E = (2. * tan(theta_0 / (2. * s->qfactor))) / sin(theta_0);
+
+ for (int b = 0; b < s->filter_count; b += 2) {
+ double D = 2. * sin(((b + 1) * M_PI) / (2. * s->filter_count));
+ double A = (1. + pow((d_E / 2.), 2)) / (D * d_E / 2.);
+ double d = sqrt((d_E * D) / (A + sqrt(A * A - 1.)));
+ double B = D * (d_E / 2.) / d;
+ double W = B + sqrt(B * B - 1.);
+
+ for (int j = 0; j < 2; j++) {
+ BiquadCoeffs *coeffs = &s->coeffs[b + j];
+
+ if (j == 1)
+ theta = 2. * atan(tan(theta_0 / 2.) / W);
+ else
+ theta = 2. * atan(W * tan(theta_0 / 2.));
+
+ beta = 0.5 * ((1. - (d / 2.) * sin(theta)) / (1. + (d / 2.) * sin(theta)));
+ gamma = (0.5 + beta) * cos(theta);
+ alpha = 0.5 * (0.5 + beta) * ((1. - cos(theta)) / (1. - cos(theta_0)));
+
+ coeffs->a1 = 2. * gamma;
+ coeffs->a2 = -2. * beta;
+ coeffs->b0 = 2. * alpha;
+ coeffs->b1 = -4. * alpha * cos(theta_0);
+ coeffs->b2 = 2. * alpha;
+ }
+ }
}
return 0;
AVFrame *in = td->in; \
const int start = (in->channels * jobnr) / nb_jobs; \
const int end = (in->channels * (jobnr+1)) / nb_jobs; \
+ const double level = s->level; \
\
for (int ch = start; ch < end; ch++) { \
const type *src = (const type *)in->extended_data[ch]; \
type *w = ((type *)s->w->extended_data[ch]) + b * 2; \
\
for (int n = 0; n < in->nb_samples; n++) { \
- type sin = b ? dst[n] : src[n]; \
+ type sin = b ? dst[n] : src[n] * level; \
type sout = sin * b0 + w[0]; \
\
w[0] = b1 * sin + w[1] + a1 * sout; \
static const AVOption asupercut_options[] = {
{ "cutoff", "set cutoff frequency", OFFSET(cutoff), AV_OPT_TYPE_DOUBLE, {.dbl=20000}, 20000, 192000, FLAGS },
{ "order", "set filter order", OFFSET(order), AV_OPT_TYPE_INT, {.i64=10}, 3, 20, FLAGS },
+ { "level", "set input level", OFFSET(level), AV_OPT_TYPE_DOUBLE, {.dbl=1.}, 0., 1., FLAGS },
{ NULL }
};
.flags = AVFILTER_FLAG_SUPPORT_TIMELINE_GENERIC |
AVFILTER_FLAG_SLICE_THREADS,
};
+
+static const AVOption asubcut_options[] = {
+ { "cutoff", "set cutoff frequency", OFFSET(cutoff), AV_OPT_TYPE_DOUBLE, {.dbl=20}, 2, 200, FLAGS },
+ { "order", "set filter order", OFFSET(order), AV_OPT_TYPE_INT, {.i64=10}, 3, 20, FLAGS },
+ { "level", "set input level", OFFSET(level), AV_OPT_TYPE_DOUBLE, {.dbl=1.}, 0., 1., FLAGS },
+ { NULL }
+};
+
+AVFILTER_DEFINE_CLASS(asubcut);
+
+AVFilter ff_af_asubcut = {
+ .name = "asubcut",
+ .description = NULL_IF_CONFIG_SMALL("Cut subwoofer frequencies."),
+ .query_formats = query_formats,
+ .priv_size = sizeof(ASuperCutContext),
+ .priv_class = &asubcut_class,
+ .uninit = uninit,
+ .inputs = inputs,
+ .outputs = outputs,
+ .process_command = process_command,
+ .flags = AVFILTER_FLAG_SUPPORT_TIMELINE_GENERIC |
+ AVFILTER_FLAG_SLICE_THREADS,
+};
+
+static const AVOption asuperpass_asuperstop_options[] = {
+ { "centerf","set center frequency", OFFSET(cutoff), AV_OPT_TYPE_DOUBLE, {.dbl=1000}, 2, 999999, FLAGS },
+ { "order", "set filter order", OFFSET(order), AV_OPT_TYPE_INT, {.i64=4}, 4, 20, FLAGS },
+ { "qfactor","set Q-factor", OFFSET(qfactor),AV_OPT_TYPE_DOUBLE, {.dbl=1.},0.01, 100., FLAGS },
+ { "level", "set input level", OFFSET(level), AV_OPT_TYPE_DOUBLE, {.dbl=1.}, 0., 2., FLAGS },
+ { NULL }
+};
+
+#define asuperpass_options asuperpass_asuperstop_options
+AVFILTER_DEFINE_CLASS(asuperpass);
+
+AVFilter ff_af_asuperpass = {
+ .name = "asuperpass",
+ .description = NULL_IF_CONFIG_SMALL("Apply high order Butterworth band-pass filter."),
+ .query_formats = query_formats,
+ .priv_size = sizeof(ASuperCutContext),
+ .priv_class = &asuperpass_class,
+ .uninit = uninit,
+ .inputs = inputs,
+ .outputs = outputs,
+ .process_command = process_command,
+ .flags = AVFILTER_FLAG_SUPPORT_TIMELINE_GENERIC |
+ AVFILTER_FLAG_SLICE_THREADS,
+};
+
+#define asuperstop_options asuperpass_asuperstop_options
+AVFILTER_DEFINE_CLASS(asuperstop);
+
+AVFilter ff_af_asuperstop = {
+ .name = "asuperstop",
+ .description = NULL_IF_CONFIG_SMALL("Apply high order Butterworth band-stop filter."),
+ .query_formats = query_formats,
+ .priv_size = sizeof(ASuperCutContext),
+ .priv_class = &asuperstop_class,
+ .uninit = uninit,
+ .inputs = inputs,
+ .outputs = outputs,
+ .process_command = process_command,
+ .flags = AVFILTER_FLAG_SUPPORT_TIMELINE_GENERIC |
+ AVFILTER_FLAG_SLICE_THREADS,
+};