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

rename bs412 names and also add debug there, convert to tabs, remove 38 khz min for mpx dev and change bs412 gain reduction logic

Browse Source
This commit is contained in:
KubaPro010
2025-04-30 20:00:00 +02:00
parent 92a358bfdb
commit 0f74e8e1b7
4 changed files with 33 additions and 21 deletions
Download Patch File Download Diff File Expand all files Collapse all files

17
dsp/bs412.c
View File

@@ -9,21 +9,30 @@ float deviation_to_dbr(float deviation) {
}
void init_modulation_power_measure(MPXPowerMeasurement* mpx, int sample_rate) {
mpx->i = 0;
mpx->sample_counter = 0;
mpx->sample = 0;
mpx->sample_rate = sample_rate;
}
float measure_mpx(MPXPowerMeasurement* mpx, float deviation) {
mpx->sample += deviation * deviation; // rmS
mpx->i++;
mpx->sample_counter++;
float avg_deviation = sqrtf(mpx->sample / mpx->i); // RMs
float avg_deviation = sqrtf(mpx->sample / mpx->sample_counter); // RMs
float modulation_power = deviation_to_dbr(avg_deviation);
#ifdef BS412_DEBUG
if(mpx->i % mpx->sample_rate == 0) {
debug_printf("MPX power: %f dBr\n", modulation_power);
}
#endif
if (mpx->i >= mpx->sample_rate * 60) {
#ifdef BS412_DEBUG
debug_printf("Resetting MPX power measurement\n");
#endif
mpx->sample = avg_deviation * avg_deviation;
mpx->i = 1;
mpx->sample_counter = 1;
}
return modulation_power;

3
dsp/bs412.h
View File

@@ -1,9 +1,10 @@
#pragma once
#include <math.h>
#include "../lib/debug.h"
typedef struct
{
int i;
int sample_counter;
int sample_rate;
double sample;
} MPXPowerMeasurement;