mirror of
https://github.com/radio95-rnt/fm95.git
synced 2026-02-26 19:23:51 +01:00
23 lines
477 B
C
23 lines
477 B
C
#include "bs412.h"
|
|
|
|
void init_modulation_power_measure(MPXPowerMeasurement* mpx, int sample_rate) {
|
|
mpx->i = 0;
|
|
mpx->sample = 0;
|
|
mpx->sample_rate = sample_rate;
|
|
}
|
|
|
|
float measure_mpx(MPXPowerMeasurement* mpx, int deviation) {
|
|
mpx->sample += 20*log10f(deviation/19000.0f);
|
|
mpx->i++;
|
|
|
|
if (mpx->i >= mpx->sample_rate) {
|
|
float modulation_power = mpx->sample/mpx->i;
|
|
|
|
mpx->sample = 0.0f;
|
|
mpx->i = 0;
|
|
|
|
return modulation_power;
|
|
} else {
|
|
return mpx->sample/mpx->i;
|
|
}
|
|
} |