From bd8bba2e11fa825585f078d9dc37fd22bce1dd1d Mon Sep 17 00:00:00 2001
From: David Sanders <dsanders11@ucsbalum.com>
Date: Fri, 11 Aug 2017 08:47:16 -0600
Subject: [PATCH] Fix stopBit = false mode in nRF51 Wire library

---
 libraries/Wire/Wire.h         |  1 +
 libraries/Wire/Wire_nRF51.cpp | 14 +++++++++++---
 2 files changed, 12 insertions(+), 3 deletions(-)

diff --git a/libraries/Wire/Wire.h b/libraries/Wire/Wire.h
index 9c3b2a8e..412ec588 100755
--- a/libraries/Wire/Wire.h
+++ b/libraries/Wire/Wire.h
@@ -84,6 +84,7 @@ class TwoWire : public Stream
     bool master;
     bool receiving;
     bool transmissionBegun;
+    bool suspended;
 
     // RX Buffer
     RingBuffer rxBuffer;
diff --git a/libraries/Wire/Wire_nRF51.cpp b/libraries/Wire/Wire_nRF51.cpp
index 91e74ad4..bb4a9d60 100755
--- a/libraries/Wire/Wire_nRF51.cpp
+++ b/libraries/Wire/Wire_nRF51.cpp
@@ -36,6 +36,7 @@ TwoWire::TwoWire(NRF_TWI_Type * p_twi, uint8_t pinSDA, uint8_t pinSCL)
   this->_uc_pinSDA = g_ADigitalPinMap[pinSDA];
   this->_uc_pinSCL = g_ADigitalPinMap[pinSCL];
   this->transmissionBegun = false;
+  this->suspended = false;
 }
 
 void TwoWire::begin(void) {
@@ -102,15 +103,20 @@ uint8_t TwoWire::requestFrom(uint8_t address, size_t quantity, bool stopBit)
 
   _p_twi->ADDRESS = address;
   _p_twi->SHORTS = 0x1UL;    // To trigger suspend task when a byte is received
-  _p_twi->TASKS_RESUME = 0x1UL;
-  _p_twi->TASKS_STARTRX = 0x1UL;
+
+  if (!this->suspended) {
+    _p_twi->TASKS_RESUME = 0x1UL;
+    _p_twi->TASKS_STARTRX = 0x1UL;
+  }
 
   for (byteRead = 0; byteRead < quantity; byteRead++)
   {
     if (byteRead == quantity - 1)
     {
       // To trigger stop task when last byte is received, set before resume task.
-      _p_twi->SHORTS = 0x2UL;
+      if (stopBit) {
+        _p_twi->SHORTS = 0x2UL;
+      }
     }
 
     _p_twi->TASKS_RESUME = 0x1UL;
@@ -129,12 +135,14 @@ uint8_t TwoWire::requestFrom(uint8_t address, size_t quantity, bool stopBit)
 
   if (stopBit || _p_twi->EVENTS_ERROR)
   {
+    this->suspended = false;
     _p_twi->TASKS_STOP = 0x1UL;
     while(!_p_twi->EVENTS_STOPPED);
     _p_twi->EVENTS_STOPPED = 0x0UL;
   }
   else
   {
+    this->suspended = true;
     _p_twi->TASKS_SUSPEND = 0x1UL;
     while(!_p_twi->EVENTS_SUSPENDED);
     _p_twi->EVENTS_SUSPENDED = 0x0UL;