|
@@ -357,10 +357,20 @@ ISR(TIMER1_COMPA_vect)
|
357
|
357
|
}
|
358
|
358
|
if((out_bits & (1<<Y_AXIS))!=0){
|
359
|
359
|
WRITE(Y_DIR_PIN, INVERT_Y_DIR);
|
|
360
|
+
|
|
361
|
+ #ifdef Y_DUAL_STEPPER_DRIVERS
|
|
362
|
+ WRITE(Y2_DIR_PIN, !(INVERT_Y_DIR == INVERT_Y2_VS_Y_DIR));
|
|
363
|
+ #endif
|
|
364
|
+
|
360
|
365
|
count_direction[Y_AXIS]=-1;
|
361
|
366
|
}
|
362
|
367
|
else{
|
363
|
368
|
WRITE(Y_DIR_PIN, !INVERT_Y_DIR);
|
|
369
|
+
|
|
370
|
+ #ifdef Y_DUAL_STEPPER_DRIVERS
|
|
371
|
+ WRITE(Y2_DIR_PIN, (INVERT_Y_DIR == INVERT_Y2_VS_Y_DIR));
|
|
372
|
+ #endif
|
|
373
|
+
|
364
|
374
|
count_direction[Y_AXIS]=1;
|
365
|
375
|
}
|
366
|
376
|
|
|
@@ -516,9 +526,18 @@ ISR(TIMER1_COMPA_vect)
|
516
|
526
|
counter_y += current_block->steps_y;
|
517
|
527
|
if (counter_y > 0) {
|
518
|
528
|
WRITE(Y_STEP_PIN, !INVERT_Y_STEP_PIN);
|
|
529
|
+
|
|
530
|
+ #ifdef Y_DUAL_STEPPER_DRIVERS
|
|
531
|
+ WRITE(Y2_STEP_PIN, !INVERT_Y_STEP_PIN);
|
|
532
|
+ #endif
|
|
533
|
+
|
519
|
534
|
counter_y -= current_block->step_event_count;
|
520
|
535
|
count_position[Y_AXIS]+=count_direction[Y_AXIS];
|
521
|
536
|
WRITE(Y_STEP_PIN, INVERT_Y_STEP_PIN);
|
|
537
|
+
|
|
538
|
+ #ifdef Y_DUAL_STEPPER_DRIVERS
|
|
539
|
+ WRITE(Y2_STEP_PIN, INVERT_Y_STEP_PIN);
|
|
540
|
+ #endif
|
522
|
541
|
}
|
523
|
542
|
|
524
|
543
|
counter_z += current_block->steps_z;
|
|
@@ -687,6 +706,10 @@ void st_init()
|
687
|
706
|
#endif
|
688
|
707
|
#if defined(Y_DIR_PIN) && Y_DIR_PIN > -1
|
689
|
708
|
SET_OUTPUT(Y_DIR_PIN);
|
|
709
|
+
|
|
710
|
+ #if defined(Y_DUAL_STEPPER_DRIVERS) && defined(Y2_DIR_PIN) && (Y2_DIR_PIN > -1)
|
|
711
|
+ SET_OUTPUT(Y2_DIR_PIN);
|
|
712
|
+ #endif
|
690
|
713
|
#endif
|
691
|
714
|
#if defined(Z_DIR_PIN) && Z_DIR_PIN > -1
|
692
|
715
|
SET_OUTPUT(Z_DIR_PIN);
|
|
@@ -714,6 +737,11 @@ void st_init()
|
714
|
737
|
#if defined(Y_ENABLE_PIN) && Y_ENABLE_PIN > -1
|
715
|
738
|
SET_OUTPUT(Y_ENABLE_PIN);
|
716
|
739
|
if(!Y_ENABLE_ON) WRITE(Y_ENABLE_PIN,HIGH);
|
|
740
|
+
|
|
741
|
+ #if defined(Y_DUAL_STEPPER_DRIVERS) && defined(Y2_ENABLE_PIN) && (Y2_ENABLE_PIN > -1)
|
|
742
|
+ SET_OUTPUT(Y2_ENABLE_PIN);
|
|
743
|
+ if(!Y_ENABLE_ON) WRITE(Y2_ENABLE_PIN,HIGH);
|
|
744
|
+ #endif
|
717
|
745
|
#endif
|
718
|
746
|
#if defined(Z_ENABLE_PIN) && Z_ENABLE_PIN > -1
|
719
|
747
|
SET_OUTPUT(Z_ENABLE_PIN);
|
|
@@ -791,6 +819,10 @@ void st_init()
|
791
|
819
|
#if defined(Y_STEP_PIN) && (Y_STEP_PIN > -1)
|
792
|
820
|
SET_OUTPUT(Y_STEP_PIN);
|
793
|
821
|
WRITE(Y_STEP_PIN,INVERT_Y_STEP_PIN);
|
|
822
|
+ #if defined(Y_DUAL_STEPPER_DRIVERS) && defined(Y2_STEP_PIN) && (Y2_STEP_PIN > -1)
|
|
823
|
+ SET_OUTPUT(Y2_STEP_PIN);
|
|
824
|
+ WRITE(Y2_STEP_PIN,INVERT_Y_STEP_PIN);
|
|
825
|
+ #endif
|
794
|
826
|
disable_y();
|
795
|
827
|
#endif
|
796
|
828
|
#if defined(Z_STEP_PIN) && (Z_STEP_PIN > -1)
|