radio95/fm95
0
1
Fork 0
mirror of https://github.com/radio95-rnt/fm95.git synced 2026-02-26 19:23:51 +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

21
lib/bs412.c
View File

@@ -1,5 +1,13 @@
#include "bs412.h" #include "bs412.h"
float dbr_to_deviation(float dbr) {
return 19000.0f * powf(10.0f, dbr / 20.0f);
}
float deviation_to_dbr(float deviation) {
return 20*log10f(deviation/19000.0f);
}
void init_modulation_power_measure(MPXPowerMeasurement* mpx, int sample_rate) { void init_modulation_power_measure(MPXPowerMeasurement* mpx, int sample_rate) {
mpx->i = 1; mpx->i = 1;
mpx->sample = 0; mpx->sample = 0;
@@ -7,21 +15,14 @@ void init_modulation_power_measure(MPXPowerMeasurement* mpx, int sample_rate) {
} }
float measure_mpx(MPXPowerMeasurement* mpx, int deviation) { float measure_mpx(MPXPowerMeasurement* mpx, int deviation) {
mpx->sample += 20*log10f(deviation/19000.0f); mpx->sample += deviation;
float modulation_power = mpx->sample/mpx->i; float avg_deviation = mpx->sample/mpx->i;
float modulation_power = deviation_to_dbr(avg_deviation);
if (mpx->i >= mpx->sample_rate*60) { if (mpx->i >= mpx->sample_rate*60) {
mpx->sample = 0; mpx->sample = 0;
mpx->i = 1; mpx->i = 1;
} }
return modulation_power; return modulation_power;
}
float dbr_to_deviation(float dbr) {
return 19000.0f * powf(10.0f, dbr / 20.0f);
}
float deviation_to_dbr(float deviation) {
return 20*log10f(deviation/19000.0f);
} }

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);