Updated 16bit register support with functional code

All code is now corrected and has no errors

Author: MadisonC-SparkFun

src/sfeTk/sfeTkIBus.h

@@ -150,7 +150,7 @@ class sfeTkIBus
         @retval int returns kSTkErrOk on success, or kSTkErrFail code
 
     */
-    virtual sfeTkError_t read16BitRegisterRegion(uint16_t reg, uint8_t *data, size_t numBytes, size_t &readBytes) = 0;
+    virtual sfeTkError_t read16BitRegisterRegion(uint16_t reg, uint8_t *data, size_t numBytes, size_t *readBytes = nullptr) = 0;
 
 };
 

src/sfeTkArdI2C.cpp

@@ -301,7 +301,7 @@ sfeTkError_t sfeTkArdI2C::readRegisterRegion(uint8_t devReg, uint8_t *data, size
 //
 // Returns the number of bytes read, < 0 is an error
 //
-sfeTkError_t sfeTkArdI2C::read16BitRegisterRegion(uint16_t devReg, uint8_t *data, size_t numBytes, size_t &readBytes)
+sfeTkError_t sfeTkArdI2C::read16BitRegisterRegion(uint16_t devReg, uint8_t *data, size_t numBytes, size_t *readBytes)
 {
 
     // got port
@@ -312,7 +312,10 @@ sfeTkError_t sfeTkArdI2C::read16BitRegisterRegion(uint16_t devReg, uint8_t *data
     if (!data)
         return kSTkErrBusNullBuffer;
 
-    readBytes = 0;
+    if(readBytes != nullptr)
+    {
+        readBytes = 0;
+    }
 
     uint16_t nOrig = numBytes; // original number of bytes.
     uint8_t nChunk;
@@ -354,7 +357,14 @@ sfeTkError_t sfeTkArdI2C::read16BitRegisterRegion(uint16_t devReg, uint8_t *data
 
     } // end while
 
-    readBytes = nOrig - numBytes; // Bytes read.
+    if(readBytes != nullptr)
+    {
+        *readBytes = nOrig - numBytes; // Bytes read.
 
-    return (readBytes == nOrig) ? kSTkErrOk : kSTkErrBusUnderRead; // Success
+        return (*readBytes == nOrig) ? kSTkErrOk : kSTkErrBusUnderRead; // Success
+    }
+    else
+    {
+        return (numBytes == 0) ? kSTkErrOk : kSTkErrBusUnderRead; // Success
+    }
 }

src/sfeTkArdI2C.h

@@ -201,7 +201,7 @@ class sfeTkArdI2C : public sfeTkII2C
         @retval int returns kSTkErrOk on success, or kSTkErrFail code
 
     */
-    sfeTkError_t read16BitRegisterRegion(uint16_t reg, uint8_t *data, size_t numBytes, size_t &readBytes);
+    sfeTkError_t read16BitRegisterRegion(uint16_t reg, uint8_t *data, size_t numBytes, size_t *readBytes = nullptr);
 
     // Buffer size chunk getter/setter
     /*--------------------------------------------------------------------------