rtl_sdr_fm: replace DC block with leaky integrator high-pass (IIR)

This commit is contained in:
arancormonk
2025-09-03 18:18:00 -04:00
parent 412a4dc3b1
commit f3ec024000

View File

@@ -790,17 +790,19 @@ void deemph_filter(struct demod_state *fm)
void dc_block_filter(struct demod_state *fm) void dc_block_filter(struct demod_state *fm)
{ {
int i, avg; int i;
int64_t sum = 0; /* Leaky integrator high-pass: dc += (x - dc) >> k; y = x - dc */
for (i=0; i < fm->result_len; i++) { int dc = fm->dc_avg;
sum += fm->result[i]; const int k = 11; /* cutoff ~ Fs / 2^k (k in 10..12) */
int16_t *res = assume_aligned_ptr(fm->result, DSD_FME_ALIGN);
DSD_FME_IVDEP
for (i = 0; i < fm->result_len; i++) {
int x = (int)res[i];
dc += (x - dc) >> k;
int y = x - dc;
res[i] = sat16(y);
} }
avg = sum / fm->result_len; fm->dc_avg = dc;
avg = (avg + fm->dc_avg * 9) / 10;
for (i=0; i < fm->result_len; i++) {
fm->result[i] -= avg;
}
fm->dc_avg = avg;
} }
long int rms(int16_t *samples, int len, int step) long int rms(int16_t *samples, int len, int step)