|
@@ -515,36 +515,31 @@ ISR(TIMER1_COMPA_vect) {
|
515
|
515
|
}
|
516
|
516
|
|
517
|
517
|
if (TEST(out_bits, Z_AXIS)) { // -direction
|
518
|
|
-
|
519
|
518
|
Z_APPLY_DIR(INVERT_Z_DIR,0);
|
520
|
519
|
count_direction[Z_AXIS] = -1;
|
521
|
|
-
|
522
|
|
- if (check_endstops) {
|
523
|
|
-
|
524
|
|
- #if defined(Z_MIN_PIN) && Z_MIN_PIN >= 0
|
525
|
|
-
|
526
|
|
- #ifdef Z_DUAL_ENDSTOPS
|
527
|
|
-
|
528
|
|
- bool z_min_endstop = READ(Z_MIN_PIN) != Z_MIN_ENDSTOP_INVERTING,
|
529
|
|
- z2_min_endstop =
|
530
|
|
- #if defined(Z2_MIN_PIN) && Z2_MIN_PIN >= 0
|
531
|
|
- READ(Z2_MIN_PIN) != Z2_MIN_ENDSTOP_INVERTING
|
532
|
|
- #else
|
533
|
|
- z_min_endstop
|
534
|
|
- #endif
|
535
|
|
- ;
|
536
|
|
-
|
537
|
|
- bool z_min_both = z_min_endstop && old_z_min_endstop,
|
538
|
|
- z2_min_both = z2_min_endstop && old_z2_min_endstop;
|
539
|
|
- if ((z_min_both || z2_min_both) && current_block->steps[Z_AXIS] > 0) {
|
|
520
|
+ if (check_endstops)
|
|
521
|
+ {
|
|
522
|
+ #if defined(Z_MIN_PIN) && Z_MIN_PIN > -1
|
|
523
|
+ #ifndef Z_DUAL_ENDSTOPS
|
|
524
|
+ UPDATE_ENDSTOP(z, Z, min, MIN);
|
|
525
|
+ #else
|
|
526
|
+ bool z_min_endstop=(READ(Z_MIN_PIN) != Z_MIN_ENDSTOP_INVERTING);
|
|
527
|
+ #if defined(Z2_MIN_PIN) && Z2_MIN_PIN > -1
|
|
528
|
+ bool z2_min_endstop=(READ(Z2_MIN_PIN) != Z2_MIN_ENDSTOP_INVERTING);
|
|
529
|
+ #else
|
|
530
|
+ bool z2_min_endstop=z_min_endstop;
|
|
531
|
+ #endif
|
|
532
|
+ if(((z_min_endstop && old_z_min_endstop) || (z2_min_endstop && old_z2_min_endstop)) && (current_block->steps[Z_AXIS] > 0))
|
|
533
|
+ {
|
540
|
534
|
endstops_trigsteps[Z_AXIS] = count_position[Z_AXIS];
|
541
|
|
- endstop_z_hit = true;
|
542
|
|
- if (!performing_homing || (performing_homing && z_min_both && z2_min_both)) //if not performing home or if both endstops were trigged during homing...
|
|
535
|
+ endstop_z_hit=true;
|
|
536
|
+ if (!(performing_homing) || ((performing_homing)&&(z_min_endstop && old_z_min_endstop)&&(z2_min_endstop && old_z2_min_endstop))) //if not performing home or if both endstops were trigged during homing...
|
|
537
|
+ {
|
543
|
538
|
step_events_completed = current_block->step_event_count;
|
|
539
|
+ }
|
544
|
540
|
}
|
545
|
541
|
old_z_min_endstop = z_min_endstop;
|
546
|
542
|
old_z2_min_endstop = z2_min_endstop;
|
547
|
|
-<<<<<<< HEAD
|
548
|
543
|
#endif
|
549
|
544
|
#endif
|
550
|
545
|
|
|
@@ -561,55 +556,37 @@ ISR(TIMER1_COMPA_vect) {
|
561
|
556
|
old_z_probe_endstop = z_probe_endstop;
|
562
|
557
|
#endif
|
563
|
558
|
}
|
564
|
|
-=======
|
565
|
|
-
|
566
|
|
- #else // !Z_DUAL_ENDSTOPS
|
567
|
|
-
|
568
|
|
- UPDATE_ENDSTOP(z, Z, min, MIN);
|
569
|
|
-
|
570
|
|
- #endif // !Z_DUAL_ENDSTOPS
|
571
|
|
-
|
572
|
|
- #endif // Z_MIN_PIN
|
573
|
|
-
|
574
|
|
- } // check_endstops
|
575
|
|
-
|
576
|
|
->>>>>>> MarlinFirmware/Development
|
577
|
559
|
}
|
578
|
560
|
else { // +direction
|
579
|
|
-
|
580
|
561
|
Z_APPLY_DIR(!INVERT_Z_DIR,0);
|
581
|
562
|
count_direction[Z_AXIS] = 1;
|
582
|
|
-
|
583
|
563
|
if (check_endstops) {
|
584
|
|
-
|
585
|
564
|
#if defined(Z_MAX_PIN) && Z_MAX_PIN >= 0
|
586
|
|
-
|
587
|
|
- #ifdef Z_DUAL_ENDSTOPS
|
588
|
|
-
|
589
|
|
- bool z_max_endstop = READ(Z_MAX_PIN) != Z_MAX_ENDSTOP_INVERTING,
|
590
|
|
- z2_max_endstop =
|
591
|
|
- #if defined(Z2_MAX_PIN) && Z2_MAX_PIN >= 0
|
592
|
|
- READ(Z2_MAX_PIN) != Z2_MAX_ENDSTOP_INVERTING
|
593
|
|
- #else
|
594
|
|
- z_max_endstop
|
595
|
|
- #endif
|
596
|
|
- ;
|
597
|
|
-
|
598
|
|
- bool z_max_both = z_max_endstop && old_z_max_endstop,
|
599
|
|
- z2_max_both = z2_max_endstop && old_z2_max_endstop;
|
600
|
|
- if ((z_max_both || z2_max_both) && current_block->steps[Z_AXIS] > 0) {
|
|
565
|
+ #ifndef Z_DUAL_ENDSTOPS
|
|
566
|
+ UPDATE_ENDSTOP(z, Z, max, MAX);
|
|
567
|
+ #else
|
|
568
|
+ bool z_max_endstop=(READ(Z_MAX_PIN) != Z_MAX_ENDSTOP_INVERTING);
|
|
569
|
+ #if defined(Z2_MAX_PIN) && Z2_MAX_PIN > -1
|
|
570
|
+ bool z2_max_endstop=(READ(Z2_MAX_PIN) != Z2_MAX_ENDSTOP_INVERTING);
|
|
571
|
+ #else
|
|
572
|
+ bool z2_max_endstop=z_max_endstop;
|
|
573
|
+ #endif
|
|
574
|
+ if(((z_max_endstop && old_z_max_endstop) || (z2_max_endstop && old_z2_max_endstop)) && (current_block->steps[Z_AXIS] > 0))
|
|
575
|
+ {
|
601
|
576
|
endstops_trigsteps[Z_AXIS] = count_position[Z_AXIS];
|
602
|
|
- endstop_z_hit = true;
|
|
577
|
+ endstop_z_hit=true;
|
603
|
578
|
|
604
|
|
- // if (z_max_both) SERIAL_ECHOLN("z_max_endstop = true");
|
605
|
|
- // if (z2_max_both) SERIAL_ECHOLN("z2_max_endstop = true");
|
|
579
|
+// if (z_max_endstop && old_z_max_endstop) SERIAL_ECHOLN("z_max_endstop = true");
|
|
580
|
+// if (z2_max_endstop && old_z2_max_endstop) SERIAL_ECHOLN("z2_max_endstop = true");
|
606
|
581
|
|
607
|
|
- if (!performing_homing || (performing_homing && z_max_both && z2_max_both)) //if not performing home or if both endstops were trigged during homing...
|
|
582
|
+
|
|
583
|
+ if (!(performing_homing) || ((performing_homing)&&(z_max_endstop && old_z_max_endstop)&&(z2_max_endstop && old_z2_max_endstop))) //if not performing home or if both endstops were trigged during homing...
|
|
584
|
+ {
|
608
|
585
|
step_events_completed = current_block->step_event_count;
|
|
586
|
+ }
|
609
|
587
|
}
|
610
|
588
|
old_z_max_endstop = z_max_endstop;
|
611
|
589
|
old_z2_max_endstop = z2_max_endstop;
|
612
|
|
-<<<<<<< HEAD
|
613
|
590
|
#endif
|
614
|
591
|
#endif
|
615
|
592
|
|
|
@@ -626,34 +603,20 @@ ISR(TIMER1_COMPA_vect) {
|
626
|
603
|
#endif
|
627
|
604
|
}
|
628
|
605
|
}
|
629
|
|
-=======
|
630
|
|
-
|
631
|
|
- #else // !Z_DUAL_ENDSTOPS
|
632
|
|
-
|
633
|
|
- UPDATE_ENDSTOP(z, Z, max, MAX);
|
634
|
|
-
|
635
|
|
- #endif // !Z_DUAL_ENDSTOPS
|
636
|
|
-
|
637
|
|
- #endif // Z_MAX_PIN
|
638
|
|
-
|
639
|
|
- } // check_endstops
|
640
|
|
-
|
641
|
|
- } // +direction
|
642
|
|
->>>>>>> MarlinFirmware/Development
|
643
|
606
|
|
644
|
607
|
#ifndef ADVANCE
|
645
|
608
|
if (TEST(out_bits, E_AXIS)) { // -direction
|
646
|
609
|
REV_E_DIR();
|
647
|
|
- count_direction[E_AXIS] = -1;
|
|
610
|
+ count_direction[E_AXIS]=-1;
|
648
|
611
|
}
|
649
|
612
|
else { // +direction
|
650
|
613
|
NORM_E_DIR();
|
651
|
|
- count_direction[E_AXIS] = 1;
|
|
614
|
+ count_direction[E_AXIS]=1;
|
652
|
615
|
}
|
653
|
616
|
#endif //!ADVANCE
|
654
|
617
|
|
655
|
618
|
// Take multiple steps per interrupt (For high speed moves)
|
656
|
|
- for (int8_t i = 0; i < step_loops; i++) {
|
|
619
|
+ for (int8_t i=0; i < step_loops; i++) {
|
657
|
620
|
#ifndef AT90USB
|
658
|
621
|
MSerial.checkRx(); // Check for serial chars.
|
659
|
622
|
#endif
|