Support step motor controllers with active low step pins.

[marlin.git] / Marlin / stepper.cpp

diff --git a/Marlin/stepper.cpp b/Marlin/stepper.cpp
index 08ed8edd9a118e7163c6e6e9c7c1e791a31610c2..6b561289cca19338f1746a29da6229938cf42652 100644 (file)
--- a/Marlin/stepper.cpp
+++ b/Marlin/stepper.cpp
@@ -449,34 +449,34 @@ ISR(TIMER1_COMPA_vect)
       
       counter_x += current_block->steps_x;
       if (counter_x > 0) {
-        WRITE(X_STEP_PIN, HIGH);
+        WRITE(X_STEP_PIN, !INVERT_X_STEP_PIN);
         counter_x -= current_block->step_event_count;
-        WRITE(X_STEP_PIN, LOW);
+        WRITE(X_STEP_PIN, INVERT_X_STEP_PIN);
         count_position[X_AXIS]+=count_direction[X_AXIS];   
       }
 
       counter_y += current_block->steps_y;
       if (counter_y > 0) {
-        WRITE(Y_STEP_PIN, HIGH);
+        WRITE(Y_STEP_PIN, !INVERT_Y_STEP_PIN);
         counter_y -= current_block->step_event_count;
-        WRITE(Y_STEP_PIN, LOW);
+        WRITE(Y_STEP_PIN, INVERT_Y_STEP_PIN);
         count_position[Y_AXIS]+=count_direction[Y_AXIS];
       }
 
       counter_z += current_block->steps_z;
       if (counter_z > 0) {
-        WRITE(Z_STEP_PIN, HIGH);
+        WRITE(Z_STEP_PIN, !INVERT_Z_STEP_PIN);
         counter_z -= current_block->step_event_count;
-        WRITE(Z_STEP_PIN, LOW);
+        WRITE(Z_STEP_PIN, INVERT_Z_STEP_PIN);
         count_position[Z_AXIS]+=count_direction[Z_AXIS];
       }
 
       #ifndef ADVANCE
         counter_e += current_block->steps_e;
         if (counter_e > 0) {
-          WRITE_E_STEP(HIGH);
+          WRITE_E_STEP(!INVERT_E_STEP_PIN);
           counter_e -= current_block->step_event_count;
-          WRITE_E_STEP(LOW);
+          WRITE_E_STEP(INVERT_E_STEP_PIN);
           count_position[E_AXIS]+=count_direction[E_AXIS];
         }
       #endif //!ADVANCE
@@ -704,27 +704,27 @@ void st_init()
   //Initialize Step Pins
   #if (X_STEP_PIN > -1) 
     SET_OUTPUT(X_STEP_PIN);
-    if(!X_ENABLE_ON) WRITE(X_ENABLE_PIN,HIGH);
+    WRITE(X_STEP_PIN,INVERT_X_STEP_PIN);
   #endif  
   #if (Y_STEP_PIN > -1) 
     SET_OUTPUT(Y_STEP_PIN);
-    if(!Y_ENABLE_ON) WRITE(Y_ENABLE_PIN,HIGH);
+    WRITE(Y_STEP_PIN,INVERT_Y_STEP_PIN);
   #endif  
   #if (Z_STEP_PIN > -1) 
     SET_OUTPUT(Z_STEP_PIN);
-    if(!Z_ENABLE_ON) WRITE(Z_ENABLE_PIN,HIGH);
+    WRITE(Z_STEP_PIN,INVERT_Z_STEP_PIN);
   #endif  
   #if (E0_STEP_PIN > -1) 
     SET_OUTPUT(E0_STEP_PIN);
-    if(!E_ENABLE_ON) WRITE(E0_ENABLE_PIN,HIGH);
+    WRITE(E0_STEP_PIN,INVERT_E_STEP_PIN);
   #endif  
   #if defined(E1_STEP_PIN) && (E1_STEP_PIN > -1) 
     SET_OUTPUT(E1_STEP_PIN);
-    if(!E_ENABLE_ON) WRITE(E1_ENABLE_PIN,HIGH);
+    WRITE(E1_STEP_PIN,INVERT_E_STEP_PIN);
   #endif  
   #if defined(E2_STEP_PIN) && (E2_STEP_PIN > -1) 
     SET_OUTPUT(E2_STEP_PIN);
-    if(!E_ENABLE_ON) WRITE(E2_ENABLE_PIN,HIGH);
+    WRITE(E2_STEP_PIN,INVERT_E_STEP_PIN);
   #endif  
 
   #ifdef CONTROLLERFAN_PIN