Add one retry to XBee

Signed-off-by: Sara Damiano <sdamiano@stroudcenter.org>
vshymanskyy · Jun 23, 2023 · 5b83997 · 5b83997
1 parent ef1a7e0
commit 5b83997
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/src/TinyGsmClientXBee.h b/src/TinyGsmClientXBee.h
@@ -1546,6 +1546,12 @@ class TinyGsmXBee : public TinyGsmModem<TinyGsmXBee>,
       sendAT(cmd, newValue);
       // return false if we attempted to change but failed
       if (waitResponse(timeout_ms) != 1) { return false; }
+      // check if we succeeded in staging a change and retry once
+      sendAT(cmd);
+      if (readResponseInt() != newValue) {
+        sendAT(cmd, newValue);
+        if (waitResponse(timeout_ms) != 1) { return false; }
+      }
       // return true if we succeeded in staging a change
       return true;
     }