fix: Fixes #1 Issue

Modbus::readInputStatus() numregs decrementation was wrong.

Author: epsilonrt

src/Modbus.cpp

@@ -486,7 +486,7 @@ void Modbus::readInputStatus (word startreg, word numregs) {
   byte bitn = 0;
   word totregs = numregs;
   word i;
-  while (numregs--) {
+  while (numregs) {
     i = (totregs - numregs) / 8;
     if (ists (startreg)) {
       bitSet (_frame[2 + i], bitn);
@@ -495,12 +495,10 @@ void Modbus::readInputStatus (word startreg, word numregs) {
       bitClear (_frame[2 + i], bitn);
     }
     //increment the bit index
-    bitn++;
-    if (bitn == 8) {
-      bitn = 0;
-    }
+    bitn = (bitn + 1) % 8;
     //increment the register
     startreg++;
+    numregs--;
   }
 
   _reply = MB_REPLY_NORMAL;