diff --git a/main.c b/main.c
index e5092b1..2fa6f83 100644
--- a/main.c
+++ b/main.c
@@ -107,6 +107,9 @@ int main(void) {
 
 		// Start Grbl-Advanced main loop. Processes program inputs and executes them.
 		Protocol_MainLoop();
+
+        // Clear serial buffer after soft reset to prevent undefined behavior
+		FifoUsart_Init();
 	}
 
     return 0;