|
|
|
@@ -256,11 +256,29 @@ av_cold struct FFIIRFilterState* ff_iir_filter_init_state(int order) |
|
|
|
} \ |
|
|
|
} |
|
|
|
|
|
|
|
#define FILTER_O2(type, fmt) { \ |
|
|
|
int i; \ |
|
|
|
const type *src0 = src; \ |
|
|
|
type *dst0 = dst; \ |
|
|
|
for (i = 0; i < size; i++) { \ |
|
|
|
float in = *src0 * c->gain + \ |
|
|
|
s->x[0] * c->cy[0] + \ |
|
|
|
s->x[1] * c->cy[1]; \ |
|
|
|
CONV_##fmt(*dst0, s->x[0] + in + s->x[1] * c->cx[1]) \ |
|
|
|
s->x[0] = s->x[1]; \ |
|
|
|
s->x[1] = in; \ |
|
|
|
src0 += sstep; \ |
|
|
|
dst0 += dstep; \ |
|
|
|
} \ |
|
|
|
} |
|
|
|
|
|
|
|
void ff_iir_filter(const struct FFIIRFilterCoeffs *c, |
|
|
|
struct FFIIRFilterState *s, int size, |
|
|
|
const int16_t *src, int sstep, int16_t *dst, int dstep) |
|
|
|
{ |
|
|
|
if (c->order == 4) { |
|
|
|
if (c->order == 2) { |
|
|
|
FILTER_O2(int16_t, S16) |
|
|
|
} else if (c->order == 4) { |
|
|
|
FILTER_BW_O4(int16_t, S16) |
|
|
|
} else { |
|
|
|
FILTER_DIRECT_FORM_II(int16_t, S16) |
|
|
|
@@ -271,7 +289,9 @@ void ff_iir_filter_flt(const struct FFIIRFilterCoeffs *c, |
|
|
|
struct FFIIRFilterState *s, int size, |
|
|
|
const float *src, int sstep, float *dst, int dstep) |
|
|
|
{ |
|
|
|
if (c->order == 4) { |
|
|
|
if (c->order == 2) { |
|
|
|
FILTER_O2(float, FLT) |
|
|
|
} else if (c->order == 4) { |
|
|
|
FILTER_BW_O4(float, FLT) |
|
|
|
} else { |
|
|
|
FILTER_DIRECT_FORM_II(float, FLT) |
|
|
|
|