From f5cf3195a8ede30c72e2fb0fee3fe54a8cfb12f9 Mon Sep 17 00:00:00 2001
From: Simen Svale Skogsrud <simen@bengler.no>
Date: Mon, 31 Jan 2011 00:17:24 +0100
Subject: [PATCH] probably fixed a bug that would crash grbl after ~20 commands

---
 stepper_plan.c | 3 ++-
 1 file changed, 2 insertions(+), 1 deletion(-)

diff --git a/stepper_plan.c b/stepper_plan.c
index 613e745..f5e5609 100644
--- a/stepper_plan.c
+++ b/stepper_plan.c
@@ -204,7 +204,8 @@ void planner_reverse_pass() {
     block[1]= block[0];
     block[0] = &block_buffer[block_index];
     planner_reverse_pass_kernel(block[0], block[1], block[2]);
-    block_index = (block_index-1) % BLOCK_BUFFER_SIZE;
+    block_index--;
+    if(block_index < 0) {block_index = BLOCK_BUFFER_SIZE-1;}
   }
   planner_reverse_pass_kernel(NULL, block[0], block[1]);
 }