spatializer: interpolate IRs

Fixes clicking
This commit is contained in:
Dmitry Sharshakov 2023-01-24 14:00:29 +03:00
parent 9399fc318e
commit 9a3bf1a6de

View file

@ -31,8 +31,10 @@ struct spatializer_impl {
struct MYSOFA_EASY *sofa; struct MYSOFA_EASY *sofa;
#endif #endif
struct convolver *l_conv; struct convolver *l_conv1;
struct convolver *r_conv; struct convolver *r_conv1;
struct convolver *l_conv2;
struct convolver *r_conv2;
}; };
static void * spatializer_instantiate(const struct fc_descriptor * Descriptor, static void * spatializer_instantiate(const struct fc_descriptor * Descriptor,
@ -136,7 +138,7 @@ static void spatializer_run(void * Instance, unsigned long SampleCount)
#ifdef HAVE_LIBMYSOFA #ifdef HAVE_LIBMYSOFA
struct spatializer_impl *impl = Instance; struct spatializer_impl *impl = Instance;
bool reload = false; bool reload = false, interpolate = false;
for (uint8_t i = 0; i < 3; i++) { for (uint8_t i = 0; i < 3; i++) {
if ((impl->port[3 + i] && impl->old_coords[i] != impl->port[3 + i][0]) if ((impl->port[3 + i] && impl->old_coords[i] != impl->port[3 + i][0])
|| isnan(impl->old_coords[i])) { || isnan(impl->old_coords[i])) {
@ -169,27 +171,59 @@ static void spatializer_run(void * Instance, unsigned long SampleCount)
pw_log_warn("delay dropped l: %f, r: %f", left_delay, right_delay); pw_log_warn("delay dropped l: %f, r: %f", left_delay, right_delay);
} }
if (impl->l_conv) if (impl->l_conv1)
convolver_free(impl->l_conv); convolver_free(impl->l_conv1);
impl->l_conv = convolver_new(dsp_ops, impl->blocksize, impl->tailsize, left_ir, impl->n_samples); impl->l_conv1 = impl->l_conv2;
impl->l_conv2 = convolver_new(dsp_ops, impl->blocksize, impl->tailsize, left_ir, impl->n_samples);
free(left_ir); free(left_ir);
if (impl->l_conv == NULL) { if (impl->l_conv2 == NULL) {
pw_log_error("reloading left convolver failed"); pw_log_error("reloading left convolver failed");
return; return;
} }
if (impl->r_conv) if (impl->r_conv1)
convolver_free(impl->r_conv); convolver_free(impl->r_conv1);
impl->r_conv = convolver_new(dsp_ops, impl->blocksize, impl->tailsize, right_ir, impl->n_samples); impl->r_conv1 = impl->r_conv2;
impl->r_conv2 = convolver_new(dsp_ops, impl->blocksize, impl->tailsize, right_ir, impl->n_samples);
free(right_ir); free(right_ir);
if (impl->r_conv == NULL) { if (impl->r_conv2 == NULL) {
pw_log_error("reloading right convolver failed"); pw_log_error("reloading right convolver failed");
return; return;
} }
// Don't interpolate on initial load
interpolate = impl->l_conv1 && impl->r_conv1;
} }
convolver_run(impl->l_conv, impl->port[2], impl->port[0], SampleCount); if (interpolate) {
convolver_run(impl->r_conv, impl->port[2], impl->port[1], SampleCount); // Convolver requires buffer of power of two size
// FIXME: actually +1 shouldn't be necessary
uint32_t len = powl(2, ceilf(log2f(SampleCount)) + 1);
float *l1 = calloc(len, sizeof(float));
float *r1 = calloc(len, sizeof(float));
float *l2 = calloc(len, sizeof(float));
float *r2 = calloc(len, sizeof(float));
convolver_run(impl->l_conv1, impl->port[2], l1, SampleCount);
convolver_run(impl->r_conv1, impl->port[2], r1, SampleCount);
convolver_run(impl->l_conv2, impl->port[2], l2, SampleCount);
convolver_run(impl->r_conv2, impl->port[2], r2, SampleCount);
for (uint32_t i = 0; i < SampleCount; i++) {
float t = (float)i / SampleCount;
impl->port[0][i] = l1[i] * (1.0f - t) + l2[i] * t;
impl->port[1][i] = r1[i] * (1.0f - t) + r2[i] * t;
}
free(l1);
free(r1);
free(l2);
free(r2);
} else {
convolver_run(impl->l_conv2, impl->port[2], impl->port[0], SampleCount);
convolver_run(impl->r_conv2, impl->port[2], impl->port[1], SampleCount);
}
#endif #endif
} }
@ -203,10 +237,16 @@ static void spatializer_connect_port(void * Instance, unsigned long Port,
static void spatializer_cleanup(void * Instance) static void spatializer_cleanup(void * Instance)
{ {
struct spatializer_impl *impl = Instance; struct spatializer_impl *impl = Instance;
if (impl->l_conv)
convolver_free(impl->l_conv); if (impl->l_conv1)
if (impl->r_conv) convolver_free(impl->l_conv1);
convolver_free(impl->r_conv); if (impl->r_conv1)
convolver_free(impl->r_conv1);
if (impl->l_conv2)
convolver_free(impl->l_conv2);
if (impl->r_conv2)
convolver_free(impl->r_conv2);
#ifdef HAVE_LIBMYSOFA #ifdef HAVE_LIBMYSOFA
if (impl->sofa) { if (impl->sofa) {
@ -222,10 +262,10 @@ static void spatializer_cleanup(void * Instance)
static void spatializer_deactivate(void * Instance) static void spatializer_deactivate(void * Instance)
{ {
struct spatializer_impl *impl = Instance; struct spatializer_impl *impl = Instance;
if (impl->l_conv) if (impl->l_conv2)
convolver_reset(impl->l_conv); convolver_reset(impl->l_conv2);
if (impl->r_conv) if (impl->r_conv2)
convolver_reset(impl->r_conv); convolver_reset(impl->r_conv2);
} }
static struct fc_port spatializer_ports[] = { static struct fc_port spatializer_ports[] = {