Improve Cordio low power assist

MukundGitHub · Kyle Kearney · commit 41dded9ec503 · 2019-08-28T10:56:15.000-07:00
Allow more flexibile configuration for BLE radio pins
diff --git a/features/FEATURE_BLE/targets/TARGET_Cypress/TARGET_CYW43XXX/CyH4TransportDriver.cpp b/features/FEATURE_BLE/targets/TARGET_Cypress/TARGET_CYW43XXX/CyH4TransportDriver.cpp
@@ -18,31 +18,59 @@
 #if DEVICE_SERIAL && DEVICE_SERIAL_FC
 
 #include "CyH4TransportDriver.h"
-#include "cycfg_pins.h"
 
 namespace ble {
 namespace vendor {
 namespace cypress_ble {
 
-CyH4TransportDriver::CyH4TransportDriver(PinName tx, PinName rx, PinName cts, PinName rts, int baud, PinName bt_host_wake_name, PinName bt_device_wake_name) :
+
+CyH4TransportDriver::CyH4TransportDriver(PinName tx, PinName rx, PinName cts, PinName rts, int baud, PinName bt_host_wake_name, PinName bt_device_wake_name, uint8_t host_wake_irq, uint8_t dev_wake_irq) :
     uart(tx, rx, baud), cts(cts), rts(rts),
     bt_host_wake_name(bt_host_wake_name),
     bt_device_wake_name(bt_device_wake_name),
     bt_host_wake(bt_host_wake_name, PIN_INPUT, PullNone, 0),
-    bt_device_wake(bt_device_wake_name, PIN_OUTPUT, PullDefault, 1)
+    bt_device_wake(bt_device_wake_name, PIN_OUTPUT, PullDefault, 1),
+    host_wake_irq_event(host_wake_irq),
+    dev_wake_irq_event(dev_wake_irq)
 {
+    enabled_powersave = true;
+}
+
+CyH4TransportDriver::CyH4TransportDriver(PinName tx, PinName rx, PinName cts, PinName rts, int baud) :
+    uart(tx, rx, baud),
+    cts(cts),
+    rts(rts),
+    bt_host_wake_name(NC),
+    bt_device_wake_name(NC),
+    bt_host_wake(bt_host_wake_name),
+    bt_device_wake(bt_device_wake_name)
+{
+    enabled_powersave = false;
+    sleep_manager_lock_deep_sleep();
+    holding_deep_sleep_lock = true;
+}
+
+CyH4TransportDriver::~CyH4TransportDriver()
+{
+    if (holding_deep_sleep_lock)
+    {
+       sleep_manager_unlock_deep_sleep();
+       holding_deep_sleep_lock = false;
+    }
 }
 
 void CyH4TransportDriver::bt_host_wake_irq_handler(void)
 {
-	sleep_manager_lock_deep_sleep();
-	CyH4TransportDriver::on_controller_irq();
-	sleep_manager_unlock_deep_sleep();
+    sleep_manager_lock_deep_sleep();
+    CyH4TransportDriver::on_controller_irq();
+    sleep_manager_unlock_deep_sleep();
 }
 
 void CyH4TransportDriver::initialize()
 {
+#if (defined(MBED_TICKLESS) && DEVICE_SLEEP && DEVICE_LPTICKER)
 	InterruptIn *host_wake_pin;
+#endif
 
     uart.format(
         /* bits */ 8,
@@ -64,10 +92,20 @@ void CyH4TransportDriver::initialize()
 #if (defined(MBED_TICKLESS) && DEVICE_SLEEP && DEVICE_LPTICKER)
     //Register IRQ for Host WAKE
     host_wake_pin = new InterruptIn(bt_host_wake_name);
-    host_wake_pin->fall(callback(this, &CyH4TransportDriver::bt_host_wake_irq_handler));
+    if (host_wake_irq_event == WAKE_EVENT_ACTIVE_LOW) {
+       host_wake_pin->fall(callback(this, &CyH4TransportDriver::bt_host_wake_irq_handler));
+    } else {
+       host_wake_pin->rise(callback(this, &CyH4TransportDriver::bt_host_wake_irq_handler));
+    }
 
 #endif
-    bt_device_wake = 0;
+    if (dev_wake_irq_event == WAKE_EVENT_ACTIVE_LOW) {
+       if (bt_device_wake_name != NC)
+           bt_device_wake = WAKE_EVENT_ACTIVE_LOW;
+    } else {
+       if (bt_device_wake_name != NC)
+           bt_device_wake = WAKE_EVENT_ACTIVE_HIGH;
+    }
     wait_ms(500);
 }
 
@@ -105,20 +143,67 @@ void CyH4TransportDriver::on_controller_irq()
 void CyH4TransportDriver::assert_bt_dev_wake()
 {
 #if (defined(MBED_TICKLESS) && DEVICE_SLEEP && DEVICE_LPTICKER)
-    bt_device_wake = 0;
+    if (dev_wake_irq_event == WAKE_EVENT_ACTIVE_LOW) {
+       bt_device_wake = WAKE_EVENT_ACTIVE_LOW;
+    } else {
+       bt_device_wake = WAKE_EVENT_ACTIVE_HIGH;
+    }
 #endif
 }
 
 void CyH4TransportDriver::deassert_bt_dev_wake()
 {
 #if (defined(MBED_TICKLESS) && DEVICE_SLEEP && DEVICE_LPTICKER)
 	//De-assert bt_device_wake
-	bt_device_wake = 1;
+    if (dev_wake_irq_event == WAKE_EVENT_ACTIVE_LOW) {
+       bt_device_wake = WAKE_EVENT_ACTIVE_HIGH;
+    } else {
+       bt_device_wake = WAKE_EVENT_ACTIVE_LOW;
+    }
 #endif
 }
 
+bool CyH4TransportDriver::get_enabled_powersave()
+{
+    return (enabled_powersave);
+}
+
+uint8_t CyH4TransportDriver::get_host_wake_irq_event()
+{
+    return (host_wake_irq_event);
+}
+
+uint8_t CyH4TransportDriver::get_dev_wake_irq_event()
+{
+    return (dev_wake_irq_event);
+}
+
+
 } // namespace cypress_ble
 } // namespace vendor
 } // namespace ble
 
+ble::vendor::cypress_ble::CyH4TransportDriver& ble_cordio_get_default_h4_transport_driver()
+{
+#if (defined(CYBSP_BT_HOST_WAKE) && defined(CYBSP_BT_DEVICE_WAKE))
+    static ble::vendor::cypress_ble::CyH4TransportDriver s_transport_driver(
+       /* TX */ CYBSP_BT_UART_TX, /* RX */ CYBSP_BT_UART_RX,
+       /* cts */ CYBSP_BT_UART_CTS, /* rts */ CYBSP_BT_UART_RTS, DEF_BT_BAUD_RATE,
+       CYBSP_BT_HOST_WAKE, CYBSP_BT_DEVICE_WAKE
+    );
+
+#else
+    static ble::vendor::cypress_ble::CyH4TransportDriver s_transport_driver(
+        /* TX */ CYBSP_BT_UART_TX, /* RX */ CYBSP_BT_UART_RX,
+        /* cts */ CYBSP_BT_UART_CTS, /* rts */ CYBSP_BT_UART_RTS, DEF_BT_BAUD_RATE);
+#endif
+    return s_transport_driver;
+}
+
+MBED_WEAK
+ble::vendor::cypress_ble::CyH4TransportDriver& ble_cordio_get_h4_transport_driver()
+{
+    return (ble_cordio_get_default_h4_transport_driver());
+}
+
 #endif
diff --git a/features/FEATURE_BLE/targets/TARGET_Cypress/TARGET_CYW43XXX/CyH4TransportDriver.h b/features/FEATURE_BLE/targets/TARGET_Cypress/TARGET_CYW43XXX/CyH4TransportDriver.h
@@ -25,7 +25,6 @@
 #include "CordioHCITransportDriver.h"
 #include "drivers/DigitalInOut.h"
 
-
 namespace ble {
 namespace vendor {
 namespace cypress_ble {
@@ -41,12 +40,14 @@ class CyH4TransportDriver : public cordio::CordioHCITransportDriver {
      * Initialize the transport driver.
      *
      */
-	CyH4TransportDriver(PinName tx, PinName rx, PinName cts, PinName rts, int baud, PinName bt_host_wake_name, PinName bt_device_wake_name);
+	CyH4TransportDriver(PinName tx, PinName rx, PinName cts, PinName rts, int baud, PinName bt_host_wake_name, PinName bt_device_wake_name,
+                            uint8_t host_wake_irq = 0, uint8_t dev_wake_irq = 0);
+        CyH4TransportDriver(PinName tx, PinName rx, PinName cts, PinName rts, int baud);
 
     /**
      * Destructor
      */
-    virtual ~CyH4TransportDriver() { }
+    virtual ~CyH4TransportDriver();
 
     /**
      * @see CordioHCITransportDriver::initialize
@@ -65,7 +66,10 @@ class CyH4TransportDriver : public cordio::CordioHCITransportDriver {
 
     void bt_host_wake_irq_handler();
 
-private:
+    bool get_enabled_powersave();
+    uint8_t get_host_wake_irq_event();
+    uint8_t get_dev_wake_irq_event();
+
 private:
     void on_controller_irq();
     void assert_bt_dev_wake();
@@ -80,13 +84,28 @@ class CyH4TransportDriver : public cordio::CordioHCITransportDriver {
     PinName rts;
     PinName bt_host_wake_name;
     PinName bt_device_wake_name;
+
     DigitalInOut bt_host_wake;
     DigitalInOut bt_device_wake;
+
+    bool     enabled_powersave;
+    uint8_t  host_wake_irq_event;
+    uint8_t  dev_wake_irq_event;
+
+    bool     holding_deep_sleep_lock;
+
 };
 
 } // namespace cypress
 } // namespace vendor
 } // namespace ble
 
+#define DEF_BT_BAUD_RATE    (115200)
+
+#define WAKE_EVENT_ACTIVE_HIGH ( 1 )      /* Interrupt Rising Edge  */
+#define WAKE_EVENT_ACTIVE_LOW  ( 0 )      /* Interrupt Falling Edge */
+
+ble::vendor::cypress_ble::CyH4TransportDriver& ble_cordio_get_default_h4_transport_driver();
+ble::vendor::cypress_ble::CyH4TransportDriver& ble_cordio_get_h4_transport_driver();
 #endif
 #endif /* CY_H4TRANSPORT_DRIVER_H_ */
diff --git a/features/FEATURE_BLE/targets/TARGET_Cypress/TARGET_CYW43XXX/HCIDriver.cpp b/features/FEATURE_BLE/targets/TARGET_Cypress/TARGET_CYW43XXX/HCIDriver.cpp
@@ -25,7 +25,6 @@
 #include <stdbool.h>
 #include "hci_mbed_os_adaptation.h"
 #include "CyH4TransportDriver.h"
-#include "cycfg_pins.h"
 
 extern const int brcm_patch_ram_length;
 extern const uint8_t brcm_patchram_buf[];
@@ -57,10 +56,16 @@ class HCIDriver : public cordio::CordioHCIDriver {
 public:
     HCIDriver(
         cordio::CordioHCITransportDriver& transport_driver,
-        PinName bt_power_name
+        PinName bt_power_name,
+	bool ps_enabled,
+	uint8_t host_wake_irq,
+	uint8_t dev_wake_irq
     ) : cordio::CordioHCIDriver(transport_driver),
         bt_power_name(bt_power_name),
         bt_power(bt_power_name, PIN_OUTPUT, PullUp, 0),
+	is_powersave_enabled(ps_enabled),
+	host_wake_irq(host_wake_irq),
+	dev_wake_irq(dev_wake_irq),
         service_pack_index(0),
         service_pack_ptr(0),
         service_pack_length(0),
@@ -343,11 +348,23 @@ class HCIDriver : public cordio::CordioHCIDriver {
             uint8_t *pBuf;
             if ((pBuf = hciCmdAlloc(HCI_VS_CMD_SET_SLEEP_MODE, 12)) != NULL)
             {
-                  pBuf[HCI_CMD_HDR_LEN] = 0x00; // no sleep
+                  if (is_powersave_on()) {
+                     pBuf[HCI_CMD_HDR_LEN] = 0x01; // sleep
+		  } else {
+                     pBuf[HCI_CMD_HDR_LEN] = 0x00; // no sleep
+		  }
                   pBuf[HCI_CMD_HDR_LEN + 1] = 0x00; // no idle threshold host (N/A)
                   pBuf[HCI_CMD_HDR_LEN + 2] = 0x00; // no idle threshold HC (N/A)
-                  pBuf[HCI_CMD_HDR_LEN + 3] = 0x00; // BT WAKE
-                  pBuf[HCI_CMD_HDR_LEN + 4] = 0x00; // HOST WAKE
+                  if (is_powersave_on()) {
+                     pBuf[HCI_CMD_HDR_LEN + 3] = dev_wake_irq; // BT WAKE
+		  } else {
+                     pBuf[HCI_CMD_HDR_LEN + 3] = 0x00; // BT WAKE
+		  }
+                  if (is_powersave_on()) {
+                      pBuf[HCI_CMD_HDR_LEN + 4] = host_wake_irq; // HOST WAKE
+		  } else {
+                     pBuf[HCI_CMD_HDR_LEN + 3] = 0x00; // BT WAKE
+		  }
                   pBuf[HCI_CMD_HDR_LEN + 5] = 0x00; // Sleep during SCO
                   pBuf[HCI_CMD_HDR_LEN + 6] = 0x00; // Combining sleep mode and SCM
                   pBuf[HCI_CMD_HDR_LEN + 7] = 0x00; // Tristate TX
@@ -406,8 +423,18 @@ class HCIDriver : public cordio::CordioHCIDriver {
         }
     }
 
+    bool is_powersave_on(void)
+    {
+       return (is_powersave_enabled);
+    }
+
     PinName bt_power_name;
     DigitalInOut bt_power;
+
+    bool is_powersave_enabled;
+    uint8_t host_wake_irq;
+    uint8_t dev_wake_irq;
+
     size_t service_pack_index;
     const uint8_t* service_pack_ptr;
     int service_pack_length;
@@ -420,15 +447,16 @@ class HCIDriver : public cordio::CordioHCIDriver {
 } // namespace vendor
 } // namespace ble
 
-ble::vendor::cordio::CordioHCIDriver& ble_cordio_get_hci_driver() {
-    static ble::vendor::cypress_ble::CyH4TransportDriver transport_driver(
-        /* TX */ CYBSP_BT_UART_TX, /* RX */ CYBSP_BT_UART_RX,
-        /* cts */ CYBSP_BT_UART_CTS, /* rts */ CYBSP_BT_UART_RTS, 115200,
-		CYBSP_BT_HOST_WAKE, CYBSP_BT_DEVICE_WAKE
-    );
+ble::vendor::cordio::CordioHCIDriver& ble_cordio_get_hci_driver()
+{
+    static ble::vendor::cypress_ble::CyH4TransportDriver& transport_driver =
+          ble_cordio_get_h4_transport_driver();
     static ble::vendor::cypress::HCIDriver hci_driver(
         transport_driver,
-        /* bt_power */ CYBSP_BT_POWER
+        /* bt_power */ CYBSP_BT_POWER,
+	transport_driver.get_enabled_powersave(),
+	transport_driver.get_host_wake_irq_event(),
+	transport_driver.get_dev_wake_irq_event()
     );
     return hci_driver;
 }
diff --git a/features/FEATURE_BLE/targets/TARGET_Cypress/TARGET_CYW43XXX/TARGET_PSOC6/cy_bt_cordio_cfg.cpp b/features/FEATURE_BLE/targets/TARGET_Cypress/TARGET_CYW43XXX/TARGET_PSOC6/cy_bt_cordio_cfg.cpp
