Fix message filtering when timing out

berarma · Sep 10, 2018 · 36ffbf2 · 36ffbf2
1 parent f34406d
commit 36ffbf2
Showing 1 changed file with 5 additions and 1 deletion.
diff --git a/src/main.cpp b/src/main.cpp
@@ -23,7 +23,7 @@ Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
 #include "sud.hpp"
 #include "io.hpp"
 
-#define TIMEOUT 5
+#define TIMEOUT 30
 
 SudData *readData(SudController *sud, unsigned char mode, unsigned char type) {
     SudData *data;
@@ -34,6 +34,10 @@ SudData *readData(SudController *sud, unsigned char mode, unsigned char type) {
         gettimeofday(&t1, NULL);
     } while ((t1.tv_sec - t0.tv_sec) < TIMEOUT && (data == NULL || data->mode != mode || data->type != type));
 
+    if (data != NULL && (data->mode != mode || data->type != type)) {
+        data = NULL;
+    }
+
     return data;
 }