radio95/fm95
0
1
Fork 0
mirror of https://github.com/radio95-rnt/fm95.git synced 2026-02-27 11:33:54 +01:00
Code Issues Activity

change bs412 measurement logic

Browse Source
This commit is contained in:
KubaPro010
2025-03-29 22:26:20 +01:00
parent 59a8359909
commit 7e867e069d
2 changed files with 14 additions and 15 deletions
Download Patch File Download Diff File Expand all files Collapse all files

37
lib/bs412.c
View File

@@ -1,23 +1,5 @@
#include "bs412.h" #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 += 20*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) { float dbr_to_deviation(float dbr) {
return 19000.0f * powf(10.0f, dbr / 20.0f); return 19000.0f * powf(10.0f, dbr / 20.0f);
} }
@@ -25,3 +7,22 @@ float dbr_to_deviation(float dbr) {
float deviation_to_dbr(float deviation) { float deviation_to_dbr(float deviation) {
return 20*log10f(deviation/19000.0f); return 20*log10f(deviation/19000.0f);
} }
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 += deviation;
float avg_deviation = mpx->sample/mpx->i;
float modulation_power = deviation_to_dbr(avg_deviation);
if (mpx->i >= mpx->sample_rate*60) {
mpx->sample = 0;
mpx->i = 1;
}
return modulation_power;
}

8
lib/bs412.h
View File

@@ -8,10 +8,8 @@ typedef struct
float sample; float sample;
} MPXPowerMeasurement; } MPXPowerMeasurement;
void init_modulation_power_measure(MPXPowerMeasurement *mpx, int sample_rate);
float measure_mpx(MPXPowerMeasurement *mpx, int deviation);
float dbr_to_deviation(float dbr); float dbr_to_deviation(float dbr);
float deviation_to_dbr(float deviation); float deviation_to_dbr(float deviation);
void init_modulation_power_measure(MPXPowerMeasurement *mpx, int sample_rate);
float measure_mpx(MPXPowerMeasurement *mpx, int deviation);