From d914089e91c92ab2f48f755eb1b19feeffb68149 Mon Sep 17 00:00:00 2001
From: Simen Svale Skogsrud <simen@bengler.no>
Date: Fri, 25 Feb 2011 15:00:47 +0100
Subject: [PATCH] spindle could not be stopped. Thanks again to Etienne for
 reporting

---
 spindle_control.c | 12 ++++++++----
 1 file changed, 8 insertions(+), 4 deletions(-)

diff --git a/spindle_control.c b/spindle_control.c
index 34d559b..0321c89 100644
--- a/spindle_control.c
+++ b/spindle_control.c
@@ -36,12 +36,16 @@ void spindle_run(int direction, uint32_t rpm)
 {
   if (direction != current_direction) {
     st_synchronize();
-    if(direction >= 0) {
-      SPINDLE_DIRECTION_PORT &= ~(1<<SPINDLE_DIRECTION_BIT);
+    if(direction) {
+      if(direction > 0) {
+        SPINDLE_DIRECTION_PORT &= ~(1<<SPINDLE_DIRECTION_BIT);
+      } else {
+        SPINDLE_DIRECTION_PORT |= 1<<SPINDLE_DIRECTION_BIT;
+      }
+      SPINDLE_ENABLE_PORT |= 1<<SPINDLE_ENABLE_BIT;
     } else {
-      SPINDLE_DIRECTION_PORT |= 1<<SPINDLE_DIRECTION_BIT;
+      SPINDLE_ENABLE_PORT &= ~(1<<SPINDLE_ENABLE_BIT);      
     }
-    SPINDLE_ENABLE_PORT |= 1<<SPINDLE_ENABLE_BIT;
     current_direction = direction;
   }
 }