Make sure we consume the double 5c (#59)

We must consume the 5c to make sure the next character does not trigger detection.
elupus · Dec 1, 2023 · 29d8cd0 · 29d8cd0
1 parent 42f339d
commit 29d8cd0
Showing 1 changed file with 13 additions and 4 deletions.
diff --git a/components/nibegw/NibeGw.cpp b/components/nibegw/NibeGw.cpp
@@ -100,11 +100,20 @@ void NibeGw::loop()
         buffer[0] = buffer[1];
         buffer[1] = b;
 
-        if (buffer[0] == 0x5C && buffer[1] != 0x5C)
+        if (buffer[0] == 0x5C)
         {
-          index = 2;
-          state = STATE_WAIT_DATA;
-          ESP_LOGVV(TAG, "Frame start found");
+          if (buffer[1] == 0x5C)
+          {
+            buffer[1] = 0x00;
+            state = STATE_WAIT_START;
+            ESP_LOGVV(TAG, "Ignore double start");
+          }
+          else
+          {
+            index = 2;
+            state = STATE_WAIT_DATA;
+            ESP_LOGVV(TAG, "Frame start found");
+          }
         }
       }
       break;