Merge pull request #353 from pennam/at-parse-fix-2

WiFiS3: Skip unaligned responses from WiFi chip

Author: pennam

Diff for: 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;
             }