Disable endstops before move, and re-enable after move.

GilesBathgate · Nov 28, 2021 · 6c23305 · 6c23305
1 parent 9ce05ca
commit 6c23305
Showing 1 changed file with 3 additions and 2 deletions.
diff --git a/Firmware/ultralcd.cpp b/Firmware/ultralcd.cpp
@@ -7499,8 +7499,8 @@ bool lcd_selftest()
 	{
 #ifdef TMC2130
 		tmc2130_home_exit();
-		enable_endstops(false);
 #endif
+		enable_endstops(false);
 
 		//homeaxis(X_AXIS);
 		//homeaxis(Y_AXIS);
@@ -7516,7 +7516,8 @@ bool lcd_selftest()
 		current_position[Z_AXIS] = current_position[Z_AXIS] + 10;
 		plan_buffer_line_curposXYZE(manual_feedrate[0] / 60);
 		st_synchronize();
-        set_destination_to_current();
+		set_destination_to_current();
+		enable_endstops(true);
 		_progress = lcd_selftest_screen(TestScreen::AxisZ, _progress, 3, true, 1500);
 #ifdef TMC2130
 		homeaxis(Z_AXIS); //In case of failure, the code gets stuck in this function.