BLE local device: add function to manage low power mode status

Author: leonardocavagnis

src/local/BLELocalDevice.cpp

@@ -478,6 +478,11 @@ void BLELocalDevice::noDebug()
   HCI.noDebug();
 }
 
+void BLELocalDevice::setLowPowerMode(bool status)
+{
+  HCI.leSetLPMode(status);
+}
+
 #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 setLowPowerMode(bool status);
+
   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;