Add function to manage low power mode status

src/local/BLELocalDevice.cpp

@@ -478,6 +478,11 @@ void BLELocalDevice::noDebug()
   HCI.noDebug();
 }
 
+void BLELocalDevice::setLowPowerModeEnabled(bool enabled)
+{
+  HCI.leSetLPMode(enabled);
+}
+
 #if !defined(FAKE_BLELOCALDEVICE)
 BLELocalDevice BLEObj;
 BLELocalDevice& BLE = BLEObj;

src/local/BLELocalDevice.h

@@ -107,6 +107,9 @@ class BLELocalDevice {
 
   virtual void setDisplayCode(void (*displayCode)(uint32_t confirmationCode));
   virtual void setBinaryConfirmPairing(bool (*binaryConfirmPairing)());
+
+  virtual void setLowPowerModeEnabled(bool enabled);
+
   uint8_t BDaddress[6];
 
 protected:

src/utility/HCI.cpp

@@ -1481,6 +1481,11 @@ void HCIClass::dumpPkt(const char* prefix, uint8_t plen, uint8_t pdata[])
   }
 }
 
+void HCIClass::leSetLPMode(bool status)
+{
+  HCITransport.setLPMode(status);
+}
+
 #if !defined(FAKE_HCI)
 HCIClass HCIObj;
 HCIClass& HCI = HCIObj;

src/utility/HCI.h

@@ -105,6 +105,8 @@ class HCIClass {
   virtual int leStartResolvingAddresses();
   virtual int leReadPeerResolvableAddress(uint8_t peerAddressType, uint8_t* peerIdentityAddress, uint8_t* peerResolvableAddress);
 
+  virtual void leSetLPMode(bool status);
+
   virtual void readStoredLKs();
   virtual int readStoredLK(uint8_t BD_ADDR[], uint8_t read_all = 0);
   virtual void writeLK(uint8_t peerAddress[], uint8_t LK[]);

src/utility/HCICordioTransport.cpp

@@ -54,6 +54,7 @@
 #endif
 
 extern BLE_NAMESPACE::CordioHCIDriver& ble_cordio_get_hci_driver();
+extern void ble_cordio_set_lp_mode(bool status);
 
 namespace BLE_NAMESPACE {
   struct CordioHCIHook {
@@ -68,6 +69,10 @@ namespace BLE_NAMESPACE {
     static void setDataReceivedHandler(void (*handler)(uint8_t*, uint8_t)) {
       getTransportDriver().set_data_received_handler(handler);
     }
+
+    static void setLowPowerMode(bool status) {
+      ble_cordio_set_lp_mode(status);
+    }
   };
 }
 
@@ -309,4 +314,9 @@ void HCICordioTransportClass::onDataReceived(uint8_t* data, uint8_t len)
   HCICordioTransport.handleRxData(data, len);
 }
 
+void HCICordioTransportClass::setLPMode(bool status) 
+{
+  CordioHCIHook::setLowPowerMode(status);
+}
+
 #endif

src/utility/HCICordioTransport.h

@@ -42,6 +42,8 @@ class HCICordioTransportClass : public HCITransportInterface {
 
   virtual size_t write(const uint8_t* data, size_t length);
 
+  virtual void setLPMode(bool status);
+
 private:
   static void onDataReceived(uint8_t* data, uint8_t len);
   void handleRxData(uint8_t* data, uint8_t len);

src/utility/HCITransport.h

@@ -34,6 +34,8 @@ class HCITransportInterface {
   virtual int read() = 0;
 
   virtual size_t write(const uint8_t* data, size_t length) = 0;
+
+  virtual void setLPMode(bool status);
 };
 
 extern HCITransportInterface& HCITransport;

src/utility/HCIUartTransport.cpp

@@ -97,6 +97,11 @@ size_t HCIUartTransportClass::write(const uint8_t* data, size_t length)
   return result;
 }
 
+void HCIUartTransportClass::setLPMode(bool status) 
+{
+  (void)status;
+}
+
 #if defined(ARDUINO_AVR_UNO_WIFI_REV2) || defined(ARDUINO_NANO_RP2040_CONNECT)
 HCIUartTransportClass HCIUartTransport(SerialHCI, 119600);
 #else

src/utility/HCIUartTransport.h

@@ -38,6 +38,8 @@ class HCIUartTransportClass : public HCITransportInterface {
 
   virtual size_t write(const uint8_t* data, size_t length);
 
+  virtual void setLPMode(bool status);
+
 private:
   HardwareSerial* _uart;
   unsigned long _baudrate;

src/utility/HCIVirtualTransport.cpp

@@ -135,6 +135,11 @@ size_t HCIVirtualTransportClass::write(const uint8_t* data, size_t length)
   return result;
 }
 
+void HCIVirtualTransportClass::setLPMode(bool status) 
+{
+  (void)status;
+}
+
 HCIVirtualTransportClass HCIVirtualTransport;
 
 HCITransportInterface& HCITransport = HCIVirtualTransport;

src/utility/HCIVirtualTransport.h

@@ -47,4 +47,6 @@ class HCIVirtualTransportClass : public HCITransportInterface {
   virtual int read();
 
   virtual size_t write(const uint8_t* data, size_t length);
+
+  virtual void setLPMode(bool status);
 };

src/utility/HCIVirtualTransportAT.cpp

@@ -105,6 +105,11 @@ size_t HCIVirtualTransportATClass::write(const uint8_t* data, size_t length)
   return 0;
 }
 
+void HCIVirtualTransportATClass::setLPMode(bool status) 
+{
+  (void)status;
+}
+
 HCIVirtualTransportATClass HCIVirtualTransportAT;
 
 HCITransportInterface& HCITransport = HCIVirtualTransportAT;

src/utility/HCIVirtualTransportAT.h

@@ -39,4 +39,6 @@ class HCIVirtualTransportATClass : public HCITransportInterface {
   virtual int read();
 
   virtual size_t write(const uint8_t* data, size_t length);
+
+  virtual void setLPMode(bool status);
 };