Add COBS draining state to ensure fast resync

orbcode · Sep 20, 2024 · d15cc3e · d15cc3e
1 parent 1dd52a6
commit d15cc3e
Show file tree

Hide file tree

Showing 2 changed files with 11 additions and 2 deletions.
diff --git a/Inc/cobs.h b/Inc/cobs.h
@@ -26,7 +26,8 @@ extern "C" {
 enum COBSPumpState
 {
     COBS_IDLE,
-    COBS_RXING
+    COBS_RXING,
+    COBS_DRAINING
 };
 
 struct Frame

diff --git a/Src/cobs.c b/Src/cobs.c
@@ -132,6 +132,14 @@ void COBSPump( struct COBS *t, const uint8_t *incoming, int len,
 
                 break;
 
+            case COBS_DRAINING:  // ---------------------------------------------------------------
+                if ( COBS_SYNC_CHAR == *fp )
+                {
+                    t->s = COBS_IDLE;
+                }
+
+                break;
+
             case COBS_RXING: // -------------------------------------------------------------------
                 t->intervalCount--;
 
@@ -160,7 +168,7 @@ void COBSPump( struct COBS *t, const uint8_t *incoming, int len,
                     if ( ( t->f.len > COBS_MAX_PACKET_LEN  ) || ( COBS_SYNC_CHAR == *fp ) )
                     {
                         t->error++;
-                        t->s = COBS_IDLE;
+                        t->s = COBS_DRAINING;
                     }
                     else
                     {