From 6334f602f1ab9df82e7e7fb3e3ffb74cc0576ea3 Mon Sep 17 00:00:00 2001
From: Kevin Le <vinhdat82@gmail.com>
Date: Sun, 9 Aug 2026 12:41:29 +0700
Subject: [PATCH] Added polling period and powersave of I2C GPS for RAK12500

---
 .../sensors/EnvironmentSensorManager.cpp      | 39 ++++++++++++-------
 1 file changed, 26 insertions(+), 13 deletions(-)

diff --git a/src/helpers/sensors/EnvironmentSensorManager.cpp b/src/helpers/sensors/EnvironmentSensorManager.cpp
index e67a392e..ffda2414 100644
--- a/src/helpers/sensors/EnvironmentSensorManager.cpp
+++ b/src/helpers/sensors/EnvironmentSensorManager.cpp
@@ -200,16 +200,21 @@ public:
   void begin() override { }
   void stop() override { }
   void loop() override {
-    if (ublox_GNSS.getGnssFixOk(8)) {
-      _fix = true;
-      _lat = ublox_GNSS.getLatitude(2) / 10;
-      _lng = ublox_GNSS.getLongitude(2) / 10;
-      _alt = ublox_GNSS.getAltitude(2);
-      _sats = ublox_GNSS.getSIV(2);
-    } else {
-      _fix = false;
+    static long next_gps_update = 0;
+    if ((int32_t)(millis() - next_gps_update) >= 0) {
+      if (ublox_GNSS.getGnssFixOk(8)) {
+        _fix = true;
+        _lat = ublox_GNSS.getLatitude(2) / 10;
+        _lng = ublox_GNSS.getLongitude(2) / 10;
+        _alt = ublox_GNSS.getAltitude(2);
+        _sats = ublox_GNSS.getSIV(2);
+      } else {
+        _fix = false;
+      }
+      _epoch = ublox_GNSS.getUnixEpoch(2);
+
+      next_gps_update = millis() + 1000;
     }
-    _epoch = ublox_GNSS.getUnixEpoch(2);
   }
   bool isEnabled() override { return true; }
   void setPinEn(int pin_en) override { _pin_en = pin_en; }
@@ -882,9 +887,14 @@ void EnvironmentSensorManager::start_gps() {
   }
 
 #ifdef RAK_WISBLOCK_GPS
-    pinMode(gpsResetPin, OUTPUT);
-    digitalWrite(gpsResetPin, HIGH); // WB_IO2
-    return;
+#ifdef FORCE_GPS_ALIVE
+  // There is no UART command to enter power save for L76K
+  if (i2cGPSFlag) ublox_GNSS.powerSaveMode(false);
+#else
+  pinMode(gpsResetPin, OUTPUT);
+  digitalWrite(gpsResetPin, HIGH); // WB_IO2
+#endif
+  return;
 #endif
 
   _location->begin();
@@ -906,7 +916,10 @@ void EnvironmentSensorManager::stop_gps() {
   }
 
   #ifdef RAK_WISBLOCK_GPS
-  #ifndef FORCE_GPS_ALIVE
+  #ifdef FORCE_GPS_ALIVE
+    // There is no UART command to enter power save for L76K
+    if(i2cGPSFlag) ublox_GNSS.powerSaveMode(false);
+  #else
     pinMode(gpsResetPin, OUTPUT);
     digitalWrite(gpsResetPin, LOW); // WB_IO2
   #endif