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

optimize

Browse Source
This commit is contained in:
KubaPro010
2025-05-31 11:30:18 +02:00
parent d41a5436b7
commit f7e0fcf84a
1 changed files with 5 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
dsp/bs412.c
View File

@@ -1,12 +1,14 @@
#include "bs412.h" #include "bs412.h"
#define LOG2_19000 log2f(19000.0f)
inline float dbr_to_deviation(float dbr) { inline float dbr_to_deviation(float dbr) {
return 19000.0f * powf(2.0f, dbr * 0.332193f); return 19000.0f * powf(2.0f, dbr * 0.332193f);
} }
inline float deviation_to_dbr(float deviation) { inline float deviation_to_dbr(float deviation) {
if(deviation == 0.0f) return -100.0f; if(deviation == 0.0f) return -100.0f;
return 10.0f * (log2f(deviation) - log2f(19000.0f)) * 0.30103f; return 10.0f * (log2f(deviation) - LOG2_19000) * 0.30103f;
} }
void init_modulation_power_measure(MPXPowerMeasurement* mpx, int sample_rate) { void init_modulation_power_measure(MPXPowerMeasurement* mpx, int sample_rate) {
@@ -22,7 +24,8 @@ float measure_mpx(MPXPowerMeasurement* mpx, float deviation) {
mpx->sample += deviation * deviation; // rmS mpx->sample += deviation * deviation; // rmS
mpx->sample_counter++; mpx->sample_counter++;
float avg_deviation = sqrtf(mpx->sample / mpx->sample_counter); // RMs float inv_counter = 1.0f / mpx->sample_counter;
float avg_deviation = sqrtf(mpx->sample * inv_counter); // RMs
float modulation_power = deviation_to_dbr(avg_deviation); float modulation_power = deviation_to_dbr(avg_deviation);
#ifdef BS412_DEBUG #ifdef BS412_DEBUG