avfilter/af_acrossover: move coefficients and state to simple arrays
This commit is contained in:
@ -39,21 +39,17 @@
|
|||||||
#define MAX_SPLITS 16
|
#define MAX_SPLITS 16
|
||||||
#define MAX_BANDS MAX_SPLITS + 1
|
#define MAX_BANDS MAX_SPLITS + 1
|
||||||
|
|
||||||
|
#define B0 0
|
||||||
|
#define B1 1
|
||||||
|
#define B2 2
|
||||||
|
#define A1 3
|
||||||
|
#define A2 4
|
||||||
|
|
||||||
typedef struct BiquadCoeffs {
|
typedef struct BiquadCoeffs {
|
||||||
double b0, b1, b2;
|
double cd[5];
|
||||||
double a1, a2;
|
float cf[5];
|
||||||
} BiquadCoeffs;
|
} BiquadCoeffs;
|
||||||
|
|
||||||
typedef struct BiquadContext {
|
|
||||||
double z1, z2;
|
|
||||||
} BiquadContext;
|
|
||||||
|
|
||||||
typedef struct CrossoverChannel {
|
|
||||||
BiquadContext lp[MAX_BANDS][20];
|
|
||||||
BiquadContext hp[MAX_BANDS][20];
|
|
||||||
BiquadContext ap[MAX_BANDS][MAX_BANDS][20];
|
|
||||||
} CrossoverChannel;
|
|
||||||
|
|
||||||
typedef struct AudioCrossoverContext {
|
typedef struct AudioCrossoverContext {
|
||||||
const AVClass *class;
|
const AVClass *class;
|
||||||
|
|
||||||
@ -72,7 +68,7 @@ typedef struct AudioCrossoverContext {
|
|||||||
BiquadCoeffs hp[MAX_BANDS][20];
|
BiquadCoeffs hp[MAX_BANDS][20];
|
||||||
BiquadCoeffs ap[MAX_BANDS][20];
|
BiquadCoeffs ap[MAX_BANDS][20];
|
||||||
|
|
||||||
CrossoverChannel *xover;
|
AVFrame *xover;
|
||||||
|
|
||||||
AVFrame *input_frame;
|
AVFrame *input_frame;
|
||||||
AVFrame *frames[MAX_BANDS];
|
AVFrame *frames[MAX_BANDS];
|
||||||
@ -178,11 +174,17 @@ static void set_lp(BiquadCoeffs *b, double fc, double q, double sr)
|
|||||||
double a1 = -2. * cosine;
|
double a1 = -2. * cosine;
|
||||||
double a2 = 1. - alpha;
|
double a2 = 1. - alpha;
|
||||||
|
|
||||||
b->b0 = b0 / a0;
|
b->cd[B0] = b0 / a0;
|
||||||
b->b1 = b1 / a0;
|
b->cd[B1] = b1 / a0;
|
||||||
b->b2 = b2 / a0;
|
b->cd[B2] = b2 / a0;
|
||||||
b->a1 = -a1 / a0;
|
b->cd[A1] = -a1 / a0;
|
||||||
b->a2 = -a2 / a0;
|
b->cd[A2] = -a2 / a0;
|
||||||
|
|
||||||
|
b->cf[B0] = b->cd[B0];
|
||||||
|
b->cf[B1] = b->cd[B1];
|
||||||
|
b->cf[B2] = b->cd[B2];
|
||||||
|
b->cf[A1] = b->cd[A1];
|
||||||
|
b->cf[A2] = b->cd[A2];
|
||||||
}
|
}
|
||||||
|
|
||||||
static void set_hp(BiquadCoeffs *b, double fc, double q, double sr)
|
static void set_hp(BiquadCoeffs *b, double fc, double q, double sr)
|
||||||
@ -198,11 +200,17 @@ static void set_hp(BiquadCoeffs *b, double fc, double q, double sr)
|
|||||||
double a1 = -2. * cosine;
|
double a1 = -2. * cosine;
|
||||||
double a2 = 1. - alpha;
|
double a2 = 1. - alpha;
|
||||||
|
|
||||||
b->b0 = b0 / a0;
|
b->cd[B0] = b0 / a0;
|
||||||
b->b1 = b1 / a0;
|
b->cd[B1] = b1 / a0;
|
||||||
b->b2 = b2 / a0;
|
b->cd[B2] = b2 / a0;
|
||||||
b->a1 = -a1 / a0;
|
b->cd[A1] = -a1 / a0;
|
||||||
b->a2 = -a2 / a0;
|
b->cd[A2] = -a2 / a0;
|
||||||
|
|
||||||
|
b->cf[B0] = b->cd[B0];
|
||||||
|
b->cf[B1] = b->cd[B1];
|
||||||
|
b->cf[B2] = b->cd[B2];
|
||||||
|
b->cf[A1] = b->cd[A1];
|
||||||
|
b->cf[A2] = b->cd[A2];
|
||||||
}
|
}
|
||||||
|
|
||||||
static void set_ap(BiquadCoeffs *b, double fc, double q, double sr)
|
static void set_ap(BiquadCoeffs *b, double fc, double q, double sr)
|
||||||
@ -218,22 +226,34 @@ static void set_ap(BiquadCoeffs *b, double fc, double q, double sr)
|
|||||||
double b1 = a1;
|
double b1 = a1;
|
||||||
double b2 = a0;
|
double b2 = a0;
|
||||||
|
|
||||||
b->b0 = b0 / a0;
|
b->cd[B0] = b0 / a0;
|
||||||
b->b1 = b1 / a0;
|
b->cd[B1] = b1 / a0;
|
||||||
b->b2 = b2 / a0;
|
b->cd[B2] = b2 / a0;
|
||||||
b->a1 = -a1 / a0;
|
b->cd[A1] = -a1 / a0;
|
||||||
b->a2 = -a2 / a0;
|
b->cd[A2] = -a2 / a0;
|
||||||
|
|
||||||
|
b->cf[B0] = b->cd[B0];
|
||||||
|
b->cf[B1] = b->cd[B1];
|
||||||
|
b->cf[B2] = b->cd[B2];
|
||||||
|
b->cf[A1] = b->cd[A1];
|
||||||
|
b->cf[A2] = b->cd[A2];
|
||||||
}
|
}
|
||||||
|
|
||||||
static void set_ap1(BiquadCoeffs *b, double fc, double sr)
|
static void set_ap1(BiquadCoeffs *b, double fc, double sr)
|
||||||
{
|
{
|
||||||
double omega = 2. * M_PI * fc / sr;
|
double omega = 2. * M_PI * fc / sr;
|
||||||
|
|
||||||
b->a1 = exp(-omega);
|
b->cd[A1] = exp(-omega);
|
||||||
b->a2 = 0.;
|
b->cd[A2] = 0.;
|
||||||
b->b0 = -b->a1;
|
b->cd[B0] = -b->cd[A1];
|
||||||
b->b1 = 1.;
|
b->cd[B1] = 1.;
|
||||||
b->b2 = 0.;
|
b->cd[B2] = 0.;
|
||||||
|
|
||||||
|
b->cf[B0] = b->cd[B0];
|
||||||
|
b->cf[B1] = b->cd[B1];
|
||||||
|
b->cf[B2] = b->cd[B2];
|
||||||
|
b->cf[A1] = b->cd[A1];
|
||||||
|
b->cf[A2] = b->cd[A2];
|
||||||
}
|
}
|
||||||
|
|
||||||
static void calc_q_factors(int order, double *q)
|
static void calc_q_factors(int order, double *q)
|
||||||
@ -275,18 +295,18 @@ static int query_formats(AVFilterContext *ctx)
|
|||||||
}
|
}
|
||||||
|
|
||||||
#define BIQUAD_PROCESS(name, type) \
|
#define BIQUAD_PROCESS(name, type) \
|
||||||
static void biquad_process_## name(const BiquadCoeffs *const c,\
|
static void biquad_process_## name(const type *const c, \
|
||||||
BiquadContext *b, \
|
type *b, \
|
||||||
type *dst, const type *src, \
|
type *dst, const type *src, \
|
||||||
int nb_samples) \
|
int nb_samples) \
|
||||||
{ \
|
{ \
|
||||||
const type b0 = c->b0; \
|
const type b0 = c[B0]; \
|
||||||
const type b1 = c->b1; \
|
const type b1 = c[B1]; \
|
||||||
const type b2 = c->b2; \
|
const type b2 = c[B2]; \
|
||||||
const type a1 = c->a1; \
|
const type a1 = c[A1]; \
|
||||||
const type a2 = c->a2; \
|
const type a2 = c[A2]; \
|
||||||
type z1 = b->z1; \
|
type z1 = b[0]; \
|
||||||
type z2 = b->z2; \
|
type z2 = b[1]; \
|
||||||
\
|
\
|
||||||
for (int n = 0; n + 1 < nb_samples; n++) { \
|
for (int n = 0; n + 1 < nb_samples; n++) { \
|
||||||
type in = src[n]; \
|
type in = src[n]; \
|
||||||
@ -316,8 +336,8 @@ static void biquad_process_## name(const BiquadCoeffs *const c,\
|
|||||||
dst[n] = out; \
|
dst[n] = out; \
|
||||||
} \
|
} \
|
||||||
\
|
\
|
||||||
b->z1 = z1; \
|
b[0] = z1; \
|
||||||
b->z2 = z2; \
|
b[1] = z2; \
|
||||||
}
|
}
|
||||||
|
|
||||||
BIQUAD_PROCESS(fltp, float)
|
BIQUAD_PROCESS(fltp, float)
|
||||||
@ -332,40 +352,41 @@ static int filter_channels_## name(AVFilterContext *ctx, void *arg, int jobnr, i
|
|||||||
const int start = (in->channels * jobnr) / nb_jobs; \
|
const int start = (in->channels * jobnr) / nb_jobs; \
|
||||||
const int end = (in->channels * (jobnr+1)) / nb_jobs; \
|
const int end = (in->channels * (jobnr+1)) / nb_jobs; \
|
||||||
const int nb_samples = in->nb_samples; \
|
const int nb_samples = in->nb_samples; \
|
||||||
|
const int nb_outs = ctx->nb_outputs; \
|
||||||
\
|
\
|
||||||
for (int ch = start; ch < end; ch++) { \
|
for (int ch = start; ch < end; ch++) { \
|
||||||
const type *src = (const type *)in->extended_data[ch]; \
|
const type *src = (const type *)in->extended_data[ch]; \
|
||||||
CrossoverChannel *xover = &s->xover[ch]; \
|
type *xover = (type *)s->xover->extended_data[ch]; \
|
||||||
\
|
\
|
||||||
s->fdsp->vector_## ff ##mul_scalar((type *)frames[0]->extended_data[ch], src, \
|
s->fdsp->vector_## ff ##mul_scalar((type *)frames[0]->extended_data[ch], src, \
|
||||||
s->level_in, FFALIGN(nb_samples, sizeof(type))); \
|
s->level_in, FFALIGN(nb_samples, sizeof(type))); \
|
||||||
\
|
\
|
||||||
for (int band = 0; band < ctx->nb_outputs; band++) { \
|
for (int band = 0; band < nb_outs; band++) { \
|
||||||
for (int f = 0; band + 1 < ctx->nb_outputs && f < s->filter_count; f++) { \
|
for (int f = 0; band + 1 < nb_outs && f < s->filter_count; f++) { \
|
||||||
const type *prv = (const type *)frames[band]->extended_data[ch]; \
|
const type *prv = (const type *)frames[band]->extended_data[ch]; \
|
||||||
type *dst = (type *)frames[band + 1]->extended_data[ch]; \
|
type *dst = (type *)frames[band + 1]->extended_data[ch]; \
|
||||||
const type *hsrc = f == 0 ? prv : dst; \
|
const type *hsrc = f == 0 ? prv : dst; \
|
||||||
BiquadContext *hp = &xover->hp[band][f]; \
|
type *hp = xover + nb_outs * 20 + band * 20 + f * 2; \
|
||||||
BiquadCoeffs *hpc = &s->hp[band][f]; \
|
const type *const hpc = (type *)&s->hp[band][f].c ## ff; \
|
||||||
\
|
\
|
||||||
biquad_process_## name(hpc, hp, dst, hsrc, nb_samples); \
|
biquad_process_## name(hpc, hp, dst, hsrc, nb_samples); \
|
||||||
} \
|
} \
|
||||||
\
|
\
|
||||||
for (int f = 0; band + 1 < ctx->nb_outputs && f < s->filter_count; f++) { \
|
for (int f = 0; band + 1 < nb_outs && f < s->filter_count; f++) { \
|
||||||
type *dst = (type *)frames[band]->extended_data[ch]; \
|
type *dst = (type *)frames[band]->extended_data[ch]; \
|
||||||
const type *lsrc = dst; \
|
const type *lsrc = dst; \
|
||||||
BiquadContext *lp = &xover->lp[band][f]; \
|
type *lp = xover + band * 20 + f * 2; \
|
||||||
BiquadCoeffs *lpc = &s->lp[band][f]; \
|
const type *const lpc = (type *)&s->lp[band][f].c ## ff; \
|
||||||
\
|
\
|
||||||
biquad_process_## name(lpc, lp, dst, lsrc, nb_samples); \
|
biquad_process_## name(lpc, lp, dst, lsrc, nb_samples); \
|
||||||
} \
|
} \
|
||||||
\
|
\
|
||||||
for (int aband = band + 1; aband + 1 < ctx->nb_outputs; aband++) { \
|
for (int aband = band + 1; aband + 1 < nb_outs; aband++) { \
|
||||||
if (s->first_order) { \
|
if (s->first_order) { \
|
||||||
const type *asrc = (const type *)frames[band]->extended_data[ch]; \
|
const type *asrc = (const type *)frames[band]->extended_data[ch]; \
|
||||||
type *dst = (type *)frames[band]->extended_data[ch]; \
|
type *dst = (type *)frames[band]->extended_data[ch]; \
|
||||||
BiquadContext *ap = &xover->ap[band][aband][0]; \
|
type *ap = xover + nb_outs * 40 + (aband * nb_outs + band) * 20; \
|
||||||
BiquadCoeffs *apc = &s->ap[aband][0]; \
|
const type *const apc = (type *)&s->ap[aband][0].c ## ff; \
|
||||||
\
|
\
|
||||||
biquad_process_## name(apc, ap, dst, asrc, nb_samples); \
|
biquad_process_## name(apc, ap, dst, asrc, nb_samples); \
|
||||||
} \
|
} \
|
||||||
@ -373,15 +394,15 @@ static int filter_channels_## name(AVFilterContext *ctx, void *arg, int jobnr, i
|
|||||||
for (int f = s->first_order; f < s->ap_filter_count; f++) { \
|
for (int f = s->first_order; f < s->ap_filter_count; f++) { \
|
||||||
const type *asrc = (const type *)frames[band]->extended_data[ch]; \
|
const type *asrc = (const type *)frames[band]->extended_data[ch]; \
|
||||||
type *dst = (type *)frames[band]->extended_data[ch]; \
|
type *dst = (type *)frames[band]->extended_data[ch]; \
|
||||||
BiquadContext *ap = &xover->ap[band][aband][f]; \
|
type *ap = xover + nb_outs * 40 + (aband * nb_outs + band) * 20 + f * 2;\
|
||||||
BiquadCoeffs *apc = &s->ap[aband][f]; \
|
const type *const apc = (type *)&s->ap[aband][f].c ## ff; \
|
||||||
\
|
\
|
||||||
biquad_process_## name(apc, ap, dst, asrc, nb_samples); \
|
biquad_process_## name(apc, ap, dst, asrc, nb_samples); \
|
||||||
} \
|
} \
|
||||||
} \
|
} \
|
||||||
} \
|
} \
|
||||||
\
|
\
|
||||||
for (int band = 0; band < ctx->nb_outputs && s->first_order; band++) { \
|
for (int band = 0; band < nb_outs && s->first_order; band++) { \
|
||||||
if (band & 1) { \
|
if (band & 1) { \
|
||||||
type *dst = (type *)frames[band]->extended_data[ch]; \
|
type *dst = (type *)frames[band]->extended_data[ch]; \
|
||||||
s->fdsp->vector_## ff ##mul_scalar(dst, dst, -one, \
|
s->fdsp->vector_## ff ##mul_scalar(dst, dst, -one, \
|
||||||
@ -403,10 +424,6 @@ static int config_input(AVFilterLink *inlink)
|
|||||||
int sample_rate = inlink->sample_rate;
|
int sample_rate = inlink->sample_rate;
|
||||||
double q[16];
|
double q[16];
|
||||||
|
|
||||||
s->xover = av_calloc(inlink->channels, sizeof(*s->xover));
|
|
||||||
if (!s->xover)
|
|
||||||
return AVERROR(ENOMEM);
|
|
||||||
|
|
||||||
s->order = (s->order_opt + 1) * 2;
|
s->order = (s->order_opt + 1) * 2;
|
||||||
s->filter_count = s->order / 2;
|
s->filter_count = s->order / 2;
|
||||||
s->first_order = s->filter_count & 1;
|
s->first_order = s->filter_count & 1;
|
||||||
@ -441,6 +458,11 @@ static int config_input(AVFilterLink *inlink)
|
|||||||
case AV_SAMPLE_FMT_DBLP: s->filter_channels = filter_channels_dblp; break;
|
case AV_SAMPLE_FMT_DBLP: s->filter_channels = filter_channels_dblp; break;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
s->xover = ff_get_audio_buffer(inlink, 2 * (ctx->nb_outputs * 10 + ctx->nb_outputs * 10 +
|
||||||
|
ctx->nb_outputs * ctx->nb_outputs * 10));
|
||||||
|
if (!s->xover)
|
||||||
|
return AVERROR(ENOMEM);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -492,7 +514,7 @@ static av_cold void uninit(AVFilterContext *ctx)
|
|||||||
|
|
||||||
av_freep(&s->fdsp);
|
av_freep(&s->fdsp);
|
||||||
av_freep(&s->splits);
|
av_freep(&s->splits);
|
||||||
av_freep(&s->xover);
|
av_frame_free(&s->xover);
|
||||||
|
|
||||||
for (i = 0; i < ctx->nb_outputs; i++)
|
for (i = 0; i < ctx->nb_outputs; i++)
|
||||||
av_freep(&ctx->output_pads[i].name);
|
av_freep(&ctx->output_pads[i].name);
|
||||||
|
Reference in New Issue
Block a user