From f78617dbdb9d2c8332f59633509685eebd80f9a6 Mon Sep 17 00:00:00 2001
From: ViezeVingertjes <michael.overhorst@gmail.com>
Date: Fri, 6 Feb 2026 11:13:28 +0100
Subject: [PATCH] Add periodic noise floor calibration and AGC reset

---
 examples/kiss_modem/main.cpp | 19 ++++++++++++++++---
 1 file changed, 16 insertions(+), 3 deletions(-)

diff --git a/examples/kiss_modem/main.cpp b/examples/kiss_modem/main.cpp
index 160adc69..62c1658f 100644
--- a/examples/kiss_modem/main.cpp
+++ b/examples/kiss_modem/main.cpp
@@ -12,9 +12,14 @@
   #include <SPIFFS.h>
 #endif
 
+#define NOISE_FLOOR_CALIB_INTERVAL_MS 2000
+#define AGC_RESET_INTERVAL_MS 30000
+
 StdRNG rng;
 mesh::LocalIdentity identity;
 KissModem* modem;
+static uint32_t next_noise_floor_calib_ms = 0;
+static uint32_t next_agc_reset_ms = 0;
 
 void halt() {
   while (1) ;
@@ -107,16 +112,24 @@ void setup() {
 void loop() {
   modem->loop();
 
+  if ((uint32_t)(millis() - next_noise_floor_calib_ms) >= NOISE_FLOOR_CALIB_INTERVAL_MS) {
+    radio_driver.triggerNoiseFloorCalibrate(0);
+    next_noise_floor_calib_ms = millis();
+  }
+  radio_driver.loop();
+
   if (!modem->isTxBusy()) {
+    if ((uint32_t)(millis() - next_agc_reset_ms) >= AGC_RESET_INTERVAL_MS) {
+      radio_driver.resetAGC();
+      next_agc_reset_ms = millis();
+    }
+
     uint8_t rx_buf[256];
     int rx_len = radio_driver.recvRaw(rx_buf, sizeof(rx_buf));
-
     if (rx_len > 0) {
       int8_t snr = (int8_t)(radio_driver.getLastSNR() * 4);
       int8_t rssi = (int8_t)radio_driver.getLastRSSI();
       modem->onPacketReceived(snr, rssi, rx_buf, rx_len);
     }
   }
-
-  radio_driver.loop();
 }