mirror of
https://gitlab.freedesktop.org/pipewire/pipewire.git
synced 2025-11-02 09:01:50 -05:00
channelmix: improve corssover processing
Apply volume after crossover, optimize when disabled or silent.
This commit is contained in:
parent
168511c157
commit
d62d2764e8
5 changed files with 52 additions and 43 deletions
|
|
@ -78,10 +78,8 @@ channelmix_f32_n_m_c(struct channelmix *mix, void * SPA_RESTRICT dst[],
|
||||||
d[i][n] = sum;
|
d[i][n] = sum;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
for (i = 0; i < n_dst; i++) {
|
for (i = 0; i < n_dst; i++)
|
||||||
if (mix->lr4_info[i] > 0)
|
lr4_process(&mix->lr4[i], d[i], d[i], 1.0f, n_samples);
|
||||||
lr4_process(&mix->lr4[i], d[i], n_samples);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -253,22 +251,20 @@ channelmix_f32_2_3p1_c(struct channelmix *mix, void * SPA_RESTRICT dst[],
|
||||||
float c = s[0][n] + s[1][n];
|
float c = s[0][n] + s[1][n];
|
||||||
d[0][n] = s[0][n];
|
d[0][n] = s[0][n];
|
||||||
d[1][n] = s[1][n];
|
d[1][n] = s[1][n];
|
||||||
d[2][n] = c * v2;
|
d[2][n] = c;
|
||||||
d[3][n] = c * v3;
|
|
||||||
}
|
}
|
||||||
if (v3 > 0.0f)
|
lr4_process(&mix->lr4[3], d[3], d[2], v3, n_samples);
|
||||||
lr4_process(&mix->lr4[3], d[3], n_samples);
|
lr4_process(&mix->lr4[2], d[2], d[2], v2, n_samples);
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
for (n = 0; n < n_samples; n++) {
|
for (n = 0; n < n_samples; n++) {
|
||||||
float c = s[0][n] + s[1][n];
|
float c = s[0][n] + s[1][n];
|
||||||
d[0][n] = s[0][n] * v0;
|
d[0][n] = s[0][n] * v0;
|
||||||
d[1][n] = s[1][n] * v1;
|
d[1][n] = s[1][n] * v1;
|
||||||
d[2][n] = c * v2;
|
d[2][n] = c;
|
||||||
d[3][n] = c * v3;
|
|
||||||
}
|
}
|
||||||
if (v3 > 0.0f)
|
lr4_process(&mix->lr4[3], d[3], d[2], v3, n_samples);
|
||||||
lr4_process(&mix->lr4[3], d[3], n_samples);
|
lr4_process(&mix->lr4[2], d[2], d[2], v2, n_samples);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -296,24 +292,22 @@ channelmix_f32_2_5p1_c(struct channelmix *mix, void * SPA_RESTRICT dst[],
|
||||||
float c = s[0][n] + s[1][n];
|
float c = s[0][n] + s[1][n];
|
||||||
d[0][n] = d[4][n] = s[0][n];
|
d[0][n] = d[4][n] = s[0][n];
|
||||||
d[1][n] = d[5][n] = s[1][n];
|
d[1][n] = d[5][n] = s[1][n];
|
||||||
d[2][n] = c * v2;
|
d[2][n] = c;
|
||||||
d[3][n] = c * v3;
|
|
||||||
}
|
}
|
||||||
if (v3 > 0.0f)
|
lr4_process(&mix->lr4[3], d[3], d[2], v3, n_samples);
|
||||||
lr4_process(&mix->lr4[3], d[3], n_samples);
|
lr4_process(&mix->lr4[2], d[2], d[2], v2, n_samples);
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
for (n = 0; n < n_samples; n++) {
|
for (n = 0; n < n_samples; n++) {
|
||||||
float c = s[0][n] + s[1][n];
|
float c = s[0][n] + s[1][n];
|
||||||
d[0][n] = s[0][n] * v0;
|
d[0][n] = s[0][n] * v0;
|
||||||
d[1][n] = s[1][n] * v1;
|
d[1][n] = s[1][n] * v1;
|
||||||
d[2][n] = c * v2;
|
d[2][n] = c;
|
||||||
d[3][n] = c * v3;
|
|
||||||
d[4][n] = s[0][n] * v4;
|
d[4][n] = s[0][n] * v4;
|
||||||
d[5][n] = s[1][n] * v5;
|
d[5][n] = s[1][n] * v5;
|
||||||
}
|
}
|
||||||
if (v3 > 0.0f)
|
lr4_process(&mix->lr4[3], d[3], d[2], v3, n_samples);
|
||||||
lr4_process(&mix->lr4[3], d[3], n_samples);
|
lr4_process(&mix->lr4[2], d[2], d[2], v2, n_samples);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -343,26 +337,24 @@ channelmix_f32_2_7p1_c(struct channelmix *mix, void * SPA_RESTRICT dst[],
|
||||||
float c = s[0][n] + s[1][n];
|
float c = s[0][n] + s[1][n];
|
||||||
d[0][n] = d[4][n] = d[6][n] = s[0][n];
|
d[0][n] = d[4][n] = d[6][n] = s[0][n];
|
||||||
d[1][n] = d[5][n] = d[7][n] = s[1][n];
|
d[1][n] = d[5][n] = d[7][n] = s[1][n];
|
||||||
d[2][n] = c * v2;
|
d[2][n] = c;
|
||||||
d[3][n] = c * v3;
|
|
||||||
}
|
}
|
||||||
if (v3 > 0.0f)
|
lr4_process(&mix->lr4[3], d[3], d[2], v3, n_samples);
|
||||||
lr4_process(&mix->lr4[3], d[3], n_samples);
|
lr4_process(&mix->lr4[2], d[2], d[2], v2, n_samples);
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
for (n = 0; n < n_samples; n++) {
|
for (n = 0; n < n_samples; n++) {
|
||||||
float c = s[0][n] + s[1][n];
|
float c = s[0][n] + s[1][n];
|
||||||
d[0][n] = s[0][n] * v0;
|
d[0][n] = s[0][n] * v0;
|
||||||
d[1][n] = s[1][n] * v1;
|
d[1][n] = s[1][n] * v1;
|
||||||
d[2][n] = c * v2;
|
d[2][n] = c;
|
||||||
d[3][n] = c * v3;
|
|
||||||
d[4][n] = s[0][n] * v4;
|
d[4][n] = s[0][n] * v4;
|
||||||
d[5][n] = s[1][n] * v5;
|
d[5][n] = s[1][n] * v5;
|
||||||
d[6][n] = s[0][n] * v6;
|
d[6][n] = s[0][n] * v6;
|
||||||
d[7][n] = s[1][n] * v7;
|
d[7][n] = s[1][n] * v7;
|
||||||
}
|
}
|
||||||
if (v3 > 0.0f)
|
lr4_process(&mix->lr4[3], d[3], d[2], v3, n_samples);
|
||||||
lr4_process(&mix->lr4[3], d[3], n_samples);
|
lr4_process(&mix->lr4[2], d[2], d[2], v2, n_samples);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -457,9 +457,8 @@ done:
|
||||||
if (i == _CH(LFE) && mix->lfe_cutoff > 0.0f) {
|
if (i == _CH(LFE) && mix->lfe_cutoff > 0.0f) {
|
||||||
spa_log_debug(mix->log, "channel %d is LFE", ic);
|
spa_log_debug(mix->log, "channel %d is LFE", ic);
|
||||||
lr4_set(&mix->lr4[ic], BQ_LOWPASS, mix->lfe_cutoff / mix->freq);
|
lr4_set(&mix->lr4[ic], BQ_LOWPASS, mix->lfe_cutoff / mix->freq);
|
||||||
mix->lr4_info[ic] = 1;
|
|
||||||
} else {
|
} else {
|
||||||
mix->lr4_info[ic] = 0;
|
mix->lr4[ic].active = false;
|
||||||
}
|
}
|
||||||
ic++;
|
ic++;
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -69,7 +69,6 @@ struct channelmix {
|
||||||
|
|
||||||
float freq; /* sample frequency */
|
float freq; /* sample frequency */
|
||||||
float lfe_cutoff; /* in Hz, 0 is disabled */
|
float lfe_cutoff; /* in Hz, 0 is disabled */
|
||||||
uint32_t lr4_info[SPA_AUDIO_MAX_CHANNELS];
|
|
||||||
struct lr4 lr4[SPA_AUDIO_MAX_CHANNELS];
|
struct lr4 lr4[SPA_AUDIO_MAX_CHANNELS];
|
||||||
|
|
||||||
void (*process) (struct channelmix *mix, void * SPA_RESTRICT dst[],
|
void (*process) (struct channelmix *mix, void * SPA_RESTRICT dst[],
|
||||||
|
|
|
||||||
|
|
@ -5,6 +5,9 @@
|
||||||
|
|
||||||
#include "config.h"
|
#include "config.h"
|
||||||
|
|
||||||
|
#include <float.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
#include "crossover.h"
|
#include "crossover.h"
|
||||||
|
|
||||||
void lr4_set(struct lr4 *lr4, enum biquad_type type, float freq)
|
void lr4_set(struct lr4 *lr4, enum biquad_type type, float freq)
|
||||||
|
|
@ -16,9 +19,10 @@ void lr4_set(struct lr4 *lr4, enum biquad_type type, float freq)
|
||||||
lr4->y2 = 0;
|
lr4->y2 = 0;
|
||||||
lr4->z1 = 0;
|
lr4->z1 = 0;
|
||||||
lr4->z2 = 0;
|
lr4->z2 = 0;
|
||||||
|
lr4->active = true;
|
||||||
}
|
}
|
||||||
|
|
||||||
void lr4_process(struct lr4 *lr4, float *data, int samples)
|
void lr4_process(struct lr4 *lr4, float *dst, const float *src, const float vol, int samples)
|
||||||
{
|
{
|
||||||
float lx1 = lr4->x1;
|
float lx1 = lr4->x1;
|
||||||
float lx2 = lr4->x2;
|
float lx2 = lr4->x2;
|
||||||
|
|
@ -31,11 +35,22 @@ void lr4_process(struct lr4 *lr4, float *data, int samples)
|
||||||
float lb2 = lr4->bq.b2;
|
float lb2 = lr4->bq.b2;
|
||||||
float la1 = lr4->bq.a1;
|
float la1 = lr4->bq.a1;
|
||||||
float la2 = lr4->bq.a2;
|
float la2 = lr4->bq.a2;
|
||||||
|
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
|
if (vol == 0.0f) {
|
||||||
|
memset(dst, 0, samples * sizeof(float));
|
||||||
|
return;
|
||||||
|
} else if (!lr4->active) {
|
||||||
|
if (src != dst || vol != 1.0f) {
|
||||||
|
for (i = 0; i < samples; i++)
|
||||||
|
dst[i] = src[i] * vol;
|
||||||
|
}
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
for (i = 0; i < samples; i++) {
|
for (i = 0; i < samples; i++) {
|
||||||
float x, y, z;
|
float x, y, z;
|
||||||
x = data[i];
|
x = src[i];
|
||||||
y = lb0*x + lb1*lx1 + lb2*lx2 - la1*ly1 - la2*ly2;
|
y = lb0*x + lb1*lx1 + lb2*lx2 - la1*ly1 - la2*ly2;
|
||||||
z = lb0*y + lb1*ly1 + lb2*ly2 - la1*lz1 - la2*lz2;
|
z = lb0*y + lb1*ly1 + lb2*ly2 - la1*lz1 - la2*lz2;
|
||||||
lx2 = lx1;
|
lx2 = lx1;
|
||||||
|
|
@ -44,13 +59,14 @@ void lr4_process(struct lr4 *lr4, float *data, int samples)
|
||||||
ly1 = y;
|
ly1 = y;
|
||||||
lz2 = lz1;
|
lz2 = lz1;
|
||||||
lz1 = z;
|
lz1 = z;
|
||||||
data[i] = z;
|
dst[i] = z * vol;
|
||||||
}
|
}
|
||||||
|
#define F(x) (-FLT_MIN < (x) && (x) < FLT_MIN ? 0.0f : (x))
|
||||||
lr4->x1 = lx1;
|
lr4->x1 = F(lx1);
|
||||||
lr4->x2 = lx2;
|
lr4->x2 = F(lx2);
|
||||||
lr4->y1 = ly1;
|
lr4->y1 = F(ly1);
|
||||||
lr4->y2 = ly2;
|
lr4->y2 = F(ly2);
|
||||||
lr4->z1 = lz1;
|
lr4->z1 = F(lz1);
|
||||||
lr4->z2 = lz2;
|
lr4->z2 = F(lz2);
|
||||||
|
#undef F
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -6,6 +6,8 @@
|
||||||
#ifndef CROSSOVER_H_
|
#ifndef CROSSOVER_H_
|
||||||
#define CROSSOVER_H_
|
#define CROSSOVER_H_
|
||||||
|
|
||||||
|
#include <stdbool.h>
|
||||||
|
|
||||||
#include "biquad.h"
|
#include "biquad.h"
|
||||||
/* An LR4 filter is two biquads with the same parameters connected in series:
|
/* An LR4 filter is two biquads with the same parameters connected in series:
|
||||||
*
|
*
|
||||||
|
|
@ -19,10 +21,11 @@ struct lr4 {
|
||||||
float x1, x2;
|
float x1, x2;
|
||||||
float y1, y2;
|
float y1, y2;
|
||||||
float z1, z2;
|
float z1, z2;
|
||||||
|
bool active;
|
||||||
};
|
};
|
||||||
|
|
||||||
void lr4_set(struct lr4 *lr4, enum biquad_type type, float freq);
|
void lr4_set(struct lr4 *lr4, enum biquad_type type, float freq);
|
||||||
|
|
||||||
void lr4_process(struct lr4 *lr4, float *data, int samples);
|
void lr4_process(struct lr4 *lr4, float *dst, const float *src, const float vol, int samples);
|
||||||
|
|
||||||
#endif /* CROSSOVER_H_ */
|
#endif /* CROSSOVER_H_ */
|
||||||
|
|
|
||||||
Loading…
Add table
Add a link
Reference in a new issue