From 83131c1f30f3ab80a02adbc5b53012df2530fa3f Mon Sep 17 00:00:00 2001
From: KubaPro010 <kuba.pro010@gmail.com>
Date: Tue, 11 Mar 2025 17:41:33 +0100
Subject: [PATCH] allow rds if when no stereo

---
 .vscode/.server-controller-port.log |  2 +-
 src/fm95.c                          | 31 +++++++++++++++++++----------
 2 files changed, 22 insertions(+), 11 deletions(-)

diff --git a/.vscode/.server-controller-port.log b/.vscode/.server-controller-port.log
index 6c4a207..52ca16d 100644
--- a/.vscode/.server-controller-port.log
+++ b/.vscode/.server-controller-port.log
@@ -1,5 +1,5 @@
 {
   "port": 13452,
-  "time": 1741636077079,
+  "time": 1741711059608,
   "version": "0.0.3"
 }
\ No newline at end of file
diff --git a/src/fm95.c b/src/fm95.c
index 8d90dba..e2cc834 100644
--- a/src/fm95.c
+++ b/src/fm95.c
@@ -20,6 +20,10 @@
 #include "../lib/fm_modulator.h"
 
 #define SAMPLE_RATE 192000
+#if SAMPLE_RATE*2 < 60000
+#warning Sample rate too low for RDS
+#define DISABLE_RDS
+#endif
 
 #define INPUT_DEVICE "FM_Audio.monitor"
 #define OUTPUT_DEVICE "alsa_output.platform-soc_sound.stereo-fallback"
@@ -173,7 +177,7 @@ int main(int argc, char **argv) {
         {"calibrate",     no_argument,       NULL, 'V'},
         {"master_vol",     required_argument,       NULL, 'A'},
         {"audio_vol",     required_argument,       NULL, 'v'},
-        
+
         {"help",        no_argument,       NULL, 'h'},
         {0,             0,                 0,    0}
 	};
@@ -415,7 +419,7 @@ int main(int argc, char **argv) {
 
     signal(SIGINT, stop);
     signal(SIGTERM, stop);
-    
+
     int pulse_error;
 
     float audio_stereo_input[BUFFER_SIZE*2]; // Input from device, interleaved stereo
@@ -467,13 +471,10 @@ int main(int argc, char **argv) {
 
             float mono = (ready_l + ready_r) / 2.0f; // Stereo to Mono
             output[i] = mono*MONO_VOLUME;
-            if(stereo == 1) {
-                float stereo = (ready_l - ready_r) / 2.0f; // Also Stereo to Mono but a bit diffrent    
-                float stereo_carrier = get_oscillator_sin_multiplier_ni(&osc, polar_stereo ? 1 : 2);   
-                if(rds_on && polar_stereo == 0) {
-                    float rds_carrier = get_oscillator_cos_multiplier_ni(&osc, 3);
-                    output[i] += (current_rds_in*rds_carrier)*RDS_VOLUME;
-                }         
+            if(stereo) {
+                float stereo = (ready_l - ready_r) / 2.0f; // Also Stereo to Mono but a bit diffrent
+                float stereo_carrier = get_oscillator_sin_multiplier_ni(&osc, polar_stereo ? 1 : 2);
+
                 if(polar_stereo) {
                     output[i] += ((stereo+0.2)*stereo_carrier)*STEREO_VOLUME;
                 } else {
@@ -481,8 +482,18 @@ int main(int argc, char **argv) {
                     output[i] += pilot*PILOT_VOLUME +
                         (stereo*stereo_carrier)*STEREO_VOLUME;
                 }
-                advance_oscillator(&osc);
             }
+#ifndef DISABLE_RDS
+            if(rds_on && polar_stereo == 0) {
+                float rds_carrier = get_oscillator_cos_multiplier_ni(&osc, 3);
+                output[i] += (current_rds_in*rds_carrier)*RDS_VOLUME;
+            }
+#endif
+            #ifndef DISABLE_RDS
+            if(rds_on || stereo) advance_oscillator(&osc);
+            #else
+            if(stereo) advance_oscillator(&osc);
+            #endif
             if(mpx_on) output[i] += hard_clip(current_mpx_in, MPX_CLIPPER_THRESHOLD)*MPX_VOLUME;
             if(sca_on) output[i] += modulate_fm(&sca_mod, hard_clip(current_sca_in, sca_clipper_threshold))*SCA_VOLUME;
             output[i] *= master_volume;