|
@@ -220,8 +220,7 @@ void Endstops::M119() {
|
220
|
220
|
// Pass the result of the endstop test
|
221
|
221
|
void Endstops::test_dual_z_endstops(EndstopEnum es1, EndstopEnum es2) {
|
222
|
222
|
byte z_test = TEST_ENDSTOP(es1) | (TEST_ENDSTOP(es2) << 1); // bit 0 for Z, bit 1 for Z2
|
223
|
|
- if (stepper.current_block->steps[Z_AXIS] > 0) {
|
224
|
|
- stepper.endstop_triggered(Z_AXIS);
|
|
223
|
+ if (z_test && stepper.current_block->steps[Z_AXIS] > 0) {
|
225
|
224
|
SBI(endstop_hit_bits, Z_MIN);
|
226
|
225
|
if (!stepper.performing_homing || (z_test == 0x3)) //if not performing home or if both endstops were trigged during homing...
|
227
|
226
|
stepper.kill_current_block();
|