Skip unaligned responses from WiFi chip

arduino · Jul 19, 2024 · e322670 · e322670
1 parent 0af3cba
commit e322670
Showing 1 changed file with 10 additions and 2 deletions.
diff --git a/libraries/WiFiS3/src/Modem.cpp b/libraries/WiFiS3/src/Modem.cpp
@@ -228,28 +228,36 @@ bool ModemClass::buf_read(const string &prompt, string &data_res) {
          }
          else {
             if(string::npos != data_res.rfind(RESULT_DATA)) {
-               found = true;
                data_res = data_res.substr(0, data_res.length() - (sizeof(RESULT_DATA) - 1));
                if(prompt != DO_NOT_CHECK_CMD) {
                   if(removeAtBegin(data_res, prompt)) {
                      res = true;
+                     found = true;
+                  } else {
+                     data_res.clear();
+                     continue;
                   }
                }
                else {
                  res = true;
+                 found = true;
                }
                break;  
             }
             else if(string::npos != data_res.rfind(RESULT_OK)){
-               found = true;
                data_res = data_res.substr(0, data_res.length() - (sizeof(RESULT_OK) - 1) );
                if(prompt != DO_NOT_CHECK_CMD) {
                   if(removeAtBegin(data_res, prompt)) {
                      res = true;
+                     found = true;
+                  } else {
+                     data_res.clear();
+                     continue;
                   }
                }
                else {
                  res = true;
+                 found = true;
                }
                break;
             }