mirror of
https://github.com/lwvmobile/dsd-fme.git
synced 2026-11-16 18:57:24 -05:00
rtl_sdr_fm: replace DC block with leaky integrator high-pass (IIR)
This commit is contained in:
@@ -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)
|
||||||
|
|||||||
Reference in New Issue
Block a user