diff --git a/sw/airborne/modules/lidar/tfmini.c b/sw/airborne/modules/lidar/tfmini.c
index 331d2d7696..7869118e4e 100644
--- a/sw/airborne/modules/lidar/tfmini.c
+++ b/sw/airborne/modules/lidar/tfmini.c
@@ -170,5 +170,10 @@ static void tfmini_parse(uint8_t byte)
       // Start reading again
       tfmini.parse_status = TFMINI_PARSE_HEAD;
       break;
+
+    default:
+      // Error, return to start
+      tfmini.parse_status = TFMINI_PARSE_HEAD;
+      break;
   }
 }