Re-implement sleep/wakeup for touch panel, display, NOR Flash, SPI and TWI.

1 files changed, 13 insertions, 1 deletions

diff --git a/src/drivers/TwiMaster.cpp b/src/drivers/TwiMaster.cpp
index 4a0c536d..14d12f9d 100644
--- a/src/drivers/TwiMaster.cpp
+++ b/src/drivers/TwiMaster.cpp
@@ -137,4 +137,16 @@ void TwiMaster::Write(uint8_t deviceAddress, const uint8_t *data, size_t size, b
     uint32_t error = twiBaseAddress->ERRORSRC;
     twiBaseAddress->ERRORSRC = error;
   }
-}
\ No newline at end of file
+}
+
+void TwiMaster::Sleep() {
+  nrf_gpio_cfg_default(6);
+  nrf_gpio_cfg_default(7);
+  twiBaseAddress->ENABLE = 0;
+  NRF_LOG_INFO("[TWIMASTER] Sleep");
+}
+
+void TwiMaster::Wakeup() {
+  Init();
+  NRF_LOG_INFO("[TWIMASTER] Wakeup");
+}