|
|
|
@ -28,12 +28,6 @@
|
|
|
|
|
|
|
|
|
|
#if ENABLED(PROBE_OFFSET_WIZARD)
|
|
|
|
|
|
|
|
|
|
#ifndef PROBE_OFFSET_START
|
|
|
|
|
#error "PROBE_OFFSET_WIZARD requires a PROBE_OFFSET_START with a negative value."
|
|
|
|
|
#else
|
|
|
|
|
static_assert(PROBE_OFFSET_START < 0, "PROBE_OFFSET_START must be < 0. Please update your configuration.");
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#include "menu_item.h"
|
|
|
|
|
#include "menu_addon.h"
|
|
|
|
|
#include "../../gcode/queue.h"
|
|
|
|
@ -46,21 +40,20 @@
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
// Global storage
|
|
|
|
|
float z_offset_backup, calculated_z_offset;
|
|
|
|
|
float z_offset_backup, calculated_z_offset, z_offset_ref;
|
|
|
|
|
|
|
|
|
|
TERN_(HAS_LEVELING, bool leveling_was_active);
|
|
|
|
|
|
|
|
|
|
void prepare_for_calibration() {
|
|
|
|
|
z_offset_backup = probe.offset.z;
|
|
|
|
|
|
|
|
|
|
// Disable soft endstops for free Z movement
|
|
|
|
|
SET_SOFT_ENDSTOP_LOOSE(true);
|
|
|
|
|
|
|
|
|
|
// Disable leveling for raw planner motion
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
leveling_was_active = planner.leveling_active;
|
|
|
|
|
set_bed_leveling_enabled(false);
|
|
|
|
|
#endif
|
|
|
|
|
inline void z_clearance_move() {
|
|
|
|
|
do_z_clearance(
|
|
|
|
|
#ifdef Z_AFTER_HOMING
|
|
|
|
|
Z_AFTER_HOMING
|
|
|
|
|
#elif defined(Z_HOMING_HEIGHT)
|
|
|
|
|
Z_HOMING_HEIGHT
|
|
|
|
|
#else
|
|
|
|
|
10
|
|
|
|
|
#endif
|
|
|
|
|
);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void set_offset_and_go_back(const float &z) {
|
|
|
|
@ -77,7 +70,7 @@ void _goto_manual_move_z(const float scale) {
|
|
|
|
|
|
|
|
|
|
void probe_offset_wizard_menu() {
|
|
|
|
|
START_MENU();
|
|
|
|
|
calculated_z_offset = probe.offset.z + current_position.z;
|
|
|
|
|
calculated_z_offset = probe.offset.z + current_position.z - z_offset_ref;
|
|
|
|
|
|
|
|
|
|
if (LCD_HEIGHT >= 4)
|
|
|
|
|
STATIC_ITEM(MSG_MOVE_NOZZLE_TO_BED, SS_CENTER|SS_INVERT);
|
|
|
|
@ -92,7 +85,7 @@ void probe_offset_wizard_menu() {
|
|
|
|
|
char tmp[20], numstr[10];
|
|
|
|
|
// Determine digits needed right of decimal
|
|
|
|
|
const uint8_t digs = !UNEAR_ZERO((SHORT_MANUAL_Z_MOVE) * 1000 - int((SHORT_MANUAL_Z_MOVE) * 1000)) ? 4 :
|
|
|
|
|
!UNEAR_ZERO((SHORT_MANUAL_Z_MOVE) * 100 - int((SHORT_MANUAL_Z_MOVE) * 100)) ? 3 : 2;
|
|
|
|
|
!UNEAR_ZERO((SHORT_MANUAL_Z_MOVE) * 100 - int((SHORT_MANUAL_Z_MOVE) * 100)) ? 3 : 2;
|
|
|
|
|
sprintf_P(tmp, GET_TEXT(MSG_MOVE_Z_DIST), dtostrf(SHORT_MANUAL_Z_MOVE, 1, digs, numstr));
|
|
|
|
|
#if DISABLED(HAS_GRAPHICAL_TFT)
|
|
|
|
|
extern const char NUL_STR[];
|
|
|
|
@ -107,47 +100,86 @@ void probe_offset_wizard_menu() {
|
|
|
|
|
|
|
|
|
|
ACTION_ITEM(MSG_BUTTON_DONE, []{
|
|
|
|
|
set_offset_and_go_back(calculated_z_offset);
|
|
|
|
|
do_z_clearance(20.0
|
|
|
|
|
#ifdef Z_AFTER_HOMING
|
|
|
|
|
- 20.0 + Z_AFTER_HOMING
|
|
|
|
|
#endif
|
|
|
|
|
);
|
|
|
|
|
current_position.z = z_offset_ref; // Set Z to z_offset_ref, as we can expect it is at probe height
|
|
|
|
|
sync_plan_position();
|
|
|
|
|
z_clearance_move(); // Raise Z as if it was homed
|
|
|
|
|
});
|
|
|
|
|
|
|
|
|
|
ACTION_ITEM(MSG_BUTTON_CANCEL, []{
|
|
|
|
|
set_offset_and_go_back(z_offset_backup);
|
|
|
|
|
// If wizard-homing was done by probe with with PROBE_OFFSET_WIZARD_START_Z
|
|
|
|
|
#if EITHER(Z_MIN_PROBE_USES_Z_MIN_ENDSTOP_PIN, USE_PROBE_FOR_Z_HOMING) && defined(PROBE_OFFSET_WIZARD_START_Z)
|
|
|
|
|
set_axis_never_homed(Z_AXIS); // On cancel the Z position needs correction
|
|
|
|
|
queue.inject_P(PSTR("G28Z"));
|
|
|
|
|
#else // Otherwise do a Z clearance move like after Homing
|
|
|
|
|
z_clearance_move();
|
|
|
|
|
#endif
|
|
|
|
|
});
|
|
|
|
|
|
|
|
|
|
END_MENU();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#ifdef PROBE_OFFSET_WIZARD_XY_POS
|
|
|
|
|
void prepare_for_probe_offset_wizard() {
|
|
|
|
|
if (ui.wait_for_move) return;
|
|
|
|
|
|
|
|
|
|
#define HAS_PROBE_OFFSET_WIZARD_XY_POS 1
|
|
|
|
|
#if defined(PROBE_OFFSET_WIZARD_XY_POS) || NONE(Z_MIN_PROBE_USES_Z_MIN_ENDSTOP_PIN, USE_PROBE_FOR_Z_HOMING)
|
|
|
|
|
if (ui.should_draw()) MenuItem_static::draw(1, GET_TEXT(MSG_PROBE_WIZARD_PROBING));
|
|
|
|
|
|
|
|
|
|
inline void goto_probe_offset_wizard() {
|
|
|
|
|
if (ui.wait_for_move) return;
|
|
|
|
|
#ifndef PROBE_OFFSET_WIZARD_XY_POS
|
|
|
|
|
#define PROBE_OFFSET_WIZARD_XY_POS XY_CENTER
|
|
|
|
|
#endif
|
|
|
|
|
// Get X and Y from configuration, or use center
|
|
|
|
|
constexpr xy_pos_t wizard_pos = PROBE_OFFSET_WIZARD_XY_POS;
|
|
|
|
|
current_position = wizard_pos;
|
|
|
|
|
|
|
|
|
|
// Probe for Z reference
|
|
|
|
|
ui.wait_for_move = true;
|
|
|
|
|
line_to_current_position(MMM_TO_MMS(HOMING_FEEDRATE_XY)); // Could invoke idle()
|
|
|
|
|
z_offset_ref = probe.probe_at_point(wizard_pos, PROBE_PT_STOW, 0, true);
|
|
|
|
|
ui.wait_for_move = false;
|
|
|
|
|
ui.synchronize();
|
|
|
|
|
prepare_for_calibration();
|
|
|
|
|
probe.offset.z = PROBE_OFFSET_START;
|
|
|
|
|
ui.goto_screen(probe_offset_wizard_menu);
|
|
|
|
|
ui.defer_status_screen();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
void home_and_goto_probe_offset_wizard() {
|
|
|
|
|
// Move Nozzle to Probing/Homing Position
|
|
|
|
|
ui.wait_for_move = true;
|
|
|
|
|
current_position += probe.offset_xy;
|
|
|
|
|
line_to_current_position(MMM_TO_MMS(HOMING_FEEDRATE_XY));
|
|
|
|
|
ui.synchronize(GET_TEXT(MSG_PROBE_WIZARD_MOVING));
|
|
|
|
|
ui.wait_for_move = false;
|
|
|
|
|
|
|
|
|
|
// Go to Calibration Menu
|
|
|
|
|
ui.goto_screen(probe_offset_wizard_menu);
|
|
|
|
|
ui.defer_status_screen();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void goto_probe_offset_wizard() {
|
|
|
|
|
ui.defer_status_screen();
|
|
|
|
|
set_all_unhomed();
|
|
|
|
|
|
|
|
|
|
// Store probe.offset.z for Case: Cancel
|
|
|
|
|
z_offset_backup = probe.offset.z;
|
|
|
|
|
|
|
|
|
|
#ifdef PROBE_OFFSET_WIZARD_START_Z
|
|
|
|
|
probe.offset.z = PROBE_OFFSET_WIZARD_START_Z;
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
// Store Bed-Leveling-State and disable
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
leveling_was_active = planner.leveling_active;
|
|
|
|
|
set_bed_leveling_enabled(false);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
// Home all axes
|
|
|
|
|
queue.inject_P(G28_STR);
|
|
|
|
|
|
|
|
|
|
ui.goto_screen([]{
|
|
|
|
|
_lcd_draw_homing();
|
|
|
|
|
if (all_axes_homed())
|
|
|
|
|
ui.goto_screen(TERN(HAS_PROBE_OFFSET_WIZARD_XY_POS, goto_probe_offset_wizard, probe_offset_wizard_menu));
|
|
|
|
|
if (all_axes_homed()) {
|
|
|
|
|
SET_SOFT_ENDSTOP_LOOSE(true); // Disable soft endstops for free Z movement
|
|
|
|
|
z_offset_ref = 0; // Set Z Value for Wizard Position to 0
|
|
|
|
|
ui.goto_screen(prepare_for_probe_offset_wizard);
|
|
|
|
|
ui.defer_status_screen();
|
|
|
|
|
}
|
|
|
|
|
});
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#endif // PROBE_OFFSET_WIZARD
|
|
|
|
|