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