} Pair;
typedef struct BiquadContext {
- double a0, a1, a2;
- double b0, b1, b2;
+ double a[3];
+ double b[3];
double i1, i2;
double o1, o2;
} BiquadContext;
int n, i; \
\
for (i = 0; i < nb_biquads; i++) { \
- const double a1 = -iir->biquads[i].a1; \
- const double a2 = -iir->biquads[i].a2; \
- const double b0 = iir->biquads[i].b0; \
- const double b1 = iir->biquads[i].b1; \
- const double b2 = iir->biquads[i].b2; \
+ const double a1 = -iir->biquads[i].a[1]; \
+ const double a2 = -iir->biquads[i].a[2]; \
+ const double b0 = iir->biquads[i].b[0]; \
+ const double b1 = iir->biquads[i].b[1]; \
+ const double b2 = iir->biquads[i].b[2]; \
double i1 = iir->biquads[i].i1; \
double i2 = iir->biquads[i].i2; \
double o1 = iir->biquads[i].o1; \
double a[6] = { 0 };
double min_distance = DBL_MAX;
double max_mag = 0;
+ double factor;
int i;
for (i = 0; i < iir->nb_ab[0]; i++) {
iir->ab[1][2 * nearest_zero.a] = iir->ab[1][2 * nearest_zero.a + 1] = NAN;
iir->ab[1][2 * nearest_zero.b] = iir->ab[1][2 * nearest_zero.b + 1] = NAN;
- iir->biquads[current_biquad].a0 = 1.0;
- iir->biquads[current_biquad].a1 = a[2] / a[4];
- iir->biquads[current_biquad].a2 = a[0] / a[4];
- iir->biquads[current_biquad].b0 = (b[4] / a[4]) * (current_biquad ? 1.0 : iir->g);
- iir->biquads[current_biquad].b1 = (b[2] / a[4]) * (current_biquad ? 1.0 : iir->g);
- iir->biquads[current_biquad].b2 = (b[0] / a[4]) * (current_biquad ? 1.0 : iir->g);
+ iir->biquads[current_biquad].a[0] = 1.;
+ iir->biquads[current_biquad].a[1] = a[2] / a[4];
+ iir->biquads[current_biquad].a[2] = a[0] / a[4];
+ iir->biquads[current_biquad].b[0] = b[4] / a[4];
+ iir->biquads[current_biquad].b[1] = b[2] / a[4];
+ iir->biquads[current_biquad].b[2] = b[0] / a[4];
+
+ if (fabs(iir->biquads[current_biquad].b[0] +
+ iir->biquads[current_biquad].b[1] +
+ iir->biquads[current_biquad].b[2]) > 1e-6) {
+ factor = (iir->biquads[current_biquad].a[0] +
+ iir->biquads[current_biquad].a[1] +
+ iir->biquads[current_biquad].a[2]) /
+ (iir->biquads[current_biquad].b[0] +
+ iir->biquads[current_biquad].b[1] +
+ iir->biquads[current_biquad].b[2]);
+
+ av_log(ctx, AV_LOG_VERBOSE, "factor=%f\n", factor);
+
+ iir->biquads[current_biquad].b[0] *= factor;
+ iir->biquads[current_biquad].b[1] *= factor;
+ iir->biquads[current_biquad].b[2] *= factor;
+ }
+
+ iir->biquads[current_biquad].b[0] *= (current_biquad ? 1.0 : iir->g);
+ iir->biquads[current_biquad].b[1] *= (current_biquad ? 1.0 : iir->g);
+ iir->biquads[current_biquad].b[2] *= (current_biquad ? 1.0 : iir->g);
av_log(ctx, AV_LOG_VERBOSE, "a=%f %f %f:b=%f %f %f\n",
- iir->biquads[current_biquad].a0,
- iir->biquads[current_biquad].a1,
- iir->biquads[current_biquad].a2,
- iir->biquads[current_biquad].b0,
- iir->biquads[current_biquad].b1,
- iir->biquads[current_biquad].b2);
+ iir->biquads[current_biquad].a[0],
+ iir->biquads[current_biquad].a[1],
+ iir->biquads[current_biquad].a[2],
+ iir->biquads[current_biquad].b[0],
+ iir->biquads[current_biquad].b[1],
+ iir->biquads[current_biquad].b[2]);
current_biquad++;
}
}
}
+static void get_response(int channel, int format, double w,
+ const double *b, const double *a,
+ int nb_b, int nb_a, double *r, double *i)
+{
+ double realz, realp;
+ double imagz, imagp;
+ double real, imag;
+ double div;
+
+ if (format == 0) {
+ realz = 0., realp = 0.;
+ imagz = 0., imagp = 0.;
+ for (int x = 0; x < nb_a; x++) {
+ realz += cos(-x * w) * a[x];
+ imagz += sin(-x * w) * a[x];
+ }
+
+ for (int x = 0; x < nb_b; x++) {
+ realp += cos(-x * w) * b[x];
+ imagp += sin(-x * w) * b[x];
+ }
+
+ div = realp * realp + imagp * imagp;
+ real = (realz * realp + imagz * imagp) / div;
+ imag = (imagz * realp - imagp * realz) / div;
+ } else {
+ real = 1;
+ imag = 0;
+ for (int x = 0; x < nb_a; x++) {
+ double ore, oim, re, im;
+
+ re = cos(w) - a[2 * x];
+ im = sin(w) - a[2 * x + 1];
+
+ ore = real;
+ oim = imag;
+
+ real = ore * re - oim * im;
+ imag = ore * im + oim * re;
+ }
+
+ for (int x = 0; x < nb_b; x++) {
+ double ore, oim, re, im;
+
+ re = cos(w) - b[2 * x];
+ im = sin(w) - b[2 * x + 1];
+
+ ore = real;
+ oim = imag;
+ div = re * re + im * im;
+
+ real = (ore * re + oim * im) / div;
+ imag = (oim * re - ore * im) / div;
+ }
+ }
+
+ *r = real;
+ *i = imag;
+}
+
static void draw_response(AVFilterContext *ctx, AVFrame *out)
{
AudioIIRContext *s = ctx->priv;
float min_delay = FLT_MAX, max_delay = FLT_MIN;
int prev_ymag = -1, prev_yphase = -1, prev_ydelay = -1;
char text[32];
- int ch, i, x;
+ int ch, i;
memset(out->data[0], 0, s->h * out->linesize[0]);
for (i = 0; i < s->w; i++) {
const double *b = s->iir[ch].ab[0];
const double *a = s->iir[ch].ab[1];
+ const int nb_b = s->iir[ch].nb_ab[0];
+ const int nb_a = s->iir[ch].nb_ab[1];
double w = i * M_PI / (s->w - 1);
- double realz, realp;
- double imagz, imagp;
- double real, imag, div;
-
- if (s->format == 0) {
- realz = 0., realp = 0.;
- imagz = 0., imagp = 0.;
- for (x = 0; x < s->iir[ch].nb_ab[1]; x++) {
- realz += cos(-x * w) * a[x];
- imagz += sin(-x * w) * a[x];
- }
-
- for (x = 0; x < s->iir[ch].nb_ab[0]; x++) {
- realp += cos(-x * w) * b[x];
- imagp += sin(-x * w) * b[x];
- }
-
- div = realp * realp + imagp * imagp;
- real = (realz * realp + imagz * imagp) / div;
- imag = (imagz * realp - imagp * realz) / div;
- } else {
- real = 1;
- imag = 0;
- for (x = 0; x < s->iir[ch].nb_ab[1]; x++) {
- double ore, oim, re, im;
-
- re = cos(w) - a[2 * x];
- im = sin(w) - a[2 * x + 1];
+ double real, imag;
- ore = real;
- oim = imag;
-
- real = ore * re - oim * im;
- imag = ore * im + oim * re;
- }
-
- for (x = 0; x < s->iir[ch].nb_ab[0]; x++) {
- double ore, oim, re, im;
-
- re = cos(w) - b[2 * x];
- im = sin(w) - b[2 * x + 1];
-
- ore = real;
- oim = imag;
- div = re * re + im * im;
-
- real = (ore * re + oim * im) / div;
- imag = (oim * re - ore * im) / div;
- }
- }
+ get_response(ch, s->format, w, b, a, nb_b, nb_a, &real, &imag);
mag[i] = s->iir[ch].g * hypot(real, imag);
phase[i] = atan2(imag, real);
projects / ffmpeg / blobdiff