Suggested readRegisterRegion changes

Author: PaulZC

src/sfe_bus.cpp

@@ -164,30 +164,29 @@ namespace sfe_KX13X
       return -1;
 
     int i;                   // counter in loop
-    bool bFirstInter = true; // Flag for first iteration - used to send register
+    int failCount = 0; // Keep track of how many times nReturned is != nChunk
 
-    while (numBytes > 0)
+    while ((numBytes > 0) && (failCount < 5)) // Give up after 5 bad requests
     {
       _i2cPort->beginTransmission(addr);
-
-      if (bFirstInter)
-      {
-        _i2cPort->write(reg);
-        bFirstInter = false;
-      }
-
+      _i2cPort->write(reg); // Write the register address we want to read from
       if (_i2cPort->endTransmission() != 0)
-        return -1; // error with the end transmission
+        return -1; // Fail immediately if the transmission isn't successful
 
       // We're chunking in data - keeping the max chunk to kMaxI2CBufferLength
-      nChunk = numBytes > kChunkSize ? kChunkSize : numBytes;
+      // The register address counts as one byte so limit nChunk to kChunkSize -1
+      nChunk = numBytes > (kChunkSize -1) ? (kChunkSize -1) : numBytes;
 
-      nReturned = _i2cPort->requestFrom((int)addr, (int)nChunk, (int)true);
+      nReturned = _i2cPort->requestFrom((int)addr, (int)nChunk, (int)true); // Always send a stop
 
       // No data returned, no dice
       if (nReturned == 0)
         return -1; // error
 
+      // Check we got back as much data as was requested
+      if (nReturned != nChunk)
+        failCount++; // Increment the failCount
+
       // Copy the retrieved data chunk to the current index in the data segment
       for (i = 0; i < nReturned; i++)
       {
@@ -197,6 +196,9 @@ namespace sfe_KX13X
       // Decrement the amount of data recieved from the overall data request amount
       numBytes = numBytes - nReturned;
 
+      // Increment reg by the same ammount
+      reg += nReturned;
+
     } // end while
 
     return 0; // Success