|
| 1 | +/** |
| 2 | + * Marlin 3D Printer Firmware |
| 3 | + * Copyright (c) 2020 MarlinFirmware [https://github.com/MarlinFirmware/Marlin] |
| 4 | + * |
| 5 | + * Based on Sprinter and grbl. |
| 6 | + * Copyright (c) 2011 Camiel Gubbels / Erik van der Zalm |
| 7 | + * |
| 8 | + * This program is free software: you can redistribute it and/or modify |
| 9 | + * it under the terms of the GNU General Public License as published by |
| 10 | + * the Free Software Foundation, either version 3 of the License, or |
| 11 | + * (at your option) any later version. |
| 12 | + * |
| 13 | + * This program is distributed in the hope that it will be useful, |
| 14 | + * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 15 | + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 16 | + * GNU General Public License for more details. |
| 17 | + * |
| 18 | + * You should have received a copy of the GNU General Public License |
| 19 | + * along with this program. If not, see <http://www.gnu.org/licenses/>. |
| 20 | + * |
| 21 | + */ |
| 22 | + |
| 23 | +// |
| 24 | +// Calibrate Probe offset menu. |
| 25 | +// |
| 26 | + |
| 27 | +#include "../../inc/MarlinConfigPre.h" |
| 28 | + |
| 29 | +#if ENABLED(PROBE_OFFSET_WIZARD) |
| 30 | + |
| 31 | +#ifndef PROBE_OFFSET_START |
| 32 | + #error "PROBE_OFFSET_WIZARD requires a PROBE_OFFSET_START with a negative value." |
| 33 | +#else |
| 34 | + static_assert(PROBE_OFFSET_START < 0, "PROBE_OFFSET_START must be < 0. Please update your configuration."); |
| 35 | +#endif |
| 36 | + |
| 37 | +#include "menu_item.h" |
| 38 | +#include "menu_addon.h" |
| 39 | +#include "../../module/motion.h" |
| 40 | +#include "../../module/planner.h" |
| 41 | +#include "../../module/probe.h" |
| 42 | + |
| 43 | +#if HAS_LEVELING |
| 44 | + #include "../../feature/bedlevel/bedlevel.h" |
| 45 | +#endif |
| 46 | + |
| 47 | +// Global storage |
| 48 | +float z_offset_backup, calculated_z_offset; |
| 49 | + |
| 50 | +TERN_(HAS_LEVELING, bool leveling_was_active); |
| 51 | +TERN_(HAS_SOFTWARE_ENDSTOPS, bool store_soft_endstops_enabled); |
| 52 | + |
| 53 | +void prepare_for_calibration() { |
| 54 | + z_offset_backup = probe.offset.z; |
| 55 | + |
| 56 | + // Disable soft endstops for free Z movement |
| 57 | + #if HAS_SOFTWARE_ENDSTOPS |
| 58 | + store_soft_endstops_enabled = soft_endstops_enabled; |
| 59 | + soft_endstops_enabled = false; |
| 60 | + #endif |
| 61 | + |
| 62 | + // Disable leveling for raw planner motion |
| 63 | + #if HAS_LEVELING |
| 64 | + leveling_was_active = planner.leveling_active; |
| 65 | + set_bed_leveling_enabled(false); |
| 66 | + #endif |
| 67 | +} |
| 68 | + |
| 69 | +void set_offset_and_go_back(const float &z) { |
| 70 | + probe.offset.z = z; |
| 71 | + TERN_(HAS_SOFTWARE_ENDSTOPS, soft_endstops_enabled = store_soft_endstops_enabled); |
| 72 | + TERN_(HAS_LEVELING, set_bed_leveling_enabled(leveling_was_active)); |
| 73 | + ui.goto_previous_screen_no_defer(); |
| 74 | +} |
| 75 | + |
| 76 | +void _goto_manual_move_z(const float scale) { |
| 77 | + ui.manual_move.menu_scale = scale; |
| 78 | + ui.goto_screen(lcd_move_z); |
| 79 | +} |
| 80 | + |
| 81 | +void probe_offset_wizard_menu() { |
| 82 | + START_MENU(); |
| 83 | + calculated_z_offset = probe.offset.z + current_position.z; |
| 84 | + |
| 85 | + if (LCD_HEIGHT >= 4) |
| 86 | + STATIC_ITEM(MSG_MOVE_NOZZLE_TO_BED, SS_CENTER|SS_INVERT); |
| 87 | + |
| 88 | + STATIC_ITEM_P(PSTR("Z="), SS_CENTER, ftostr42_52(current_position.z)); |
| 89 | + STATIC_ITEM(MSG_ZPROBE_ZOFFSET, SS_LEFT, ftostr42_52(calculated_z_offset)); |
| 90 | + |
| 91 | + SUBMENU(MSG_MOVE_1MM, []{ _goto_manual_move_z( 1); }); |
| 92 | + SUBMENU(MSG_MOVE_01MM, []{ _goto_manual_move_z( 0.1f); }); |
| 93 | + |
| 94 | + if ((SHORT_MANUAL_Z_MOVE) > 0.0f && (SHORT_MANUAL_Z_MOVE) < 0.1f) { |
| 95 | + extern const char NUL_STR[]; |
| 96 | + SUBMENU_P(NUL_STR, []{ _goto_manual_move_z(float(SHORT_MANUAL_Z_MOVE)); }); |
| 97 | + MENU_ITEM_ADDON_START(0 + ENABLED(HAS_CHARACTER_LCD)); |
| 98 | + char tmp[20], numstr[10]; |
| 99 | + // Determine digits needed right of decimal |
| 100 | + const uint8_t digs = !UNEAR_ZERO((SHORT_MANUAL_Z_MOVE) * 1000 - int((SHORT_MANUAL_Z_MOVE) * 1000)) ? 4 : |
| 101 | + !UNEAR_ZERO((SHORT_MANUAL_Z_MOVE) * 100 - int((SHORT_MANUAL_Z_MOVE) * 100)) ? 3 : 2; |
| 102 | + sprintf_P(tmp, GET_TEXT(MSG_MOVE_Z_DIST), dtostrf(SHORT_MANUAL_Z_MOVE, 1, digs, numstr)); |
| 103 | + lcd_put_u8str(tmp); |
| 104 | + MENU_ITEM_ADDON_END(); |
| 105 | + } |
| 106 | + |
| 107 | + ACTION_ITEM(MSG_BUTTON_DONE, []{ |
| 108 | + set_offset_and_go_back(calculated_z_offset); |
| 109 | + do_z_clearance(20.0 |
| 110 | + #ifdef Z_AFTER_HOMING |
| 111 | + - 20.0 + Z_AFTER_HOMING |
| 112 | + #endif |
| 113 | + ); |
| 114 | + }); |
| 115 | + |
| 116 | + ACTION_ITEM(MSG_BUTTON_CANCEL, []{ |
| 117 | + set_offset_and_go_back(z_offset_backup); |
| 118 | + }); |
| 119 | + |
| 120 | + END_MENU(); |
| 121 | +} |
| 122 | + |
| 123 | +void goto_probe_offset_wizard() { |
| 124 | + ui.defer_status_screen(); |
| 125 | + |
| 126 | + prepare_for_calibration(); |
| 127 | + |
| 128 | + probe.offset.z = PROBE_OFFSET_START; |
| 129 | + |
| 130 | + set_all_unhomed(); |
| 131 | + queue.inject_P(G28_STR); |
| 132 | + |
| 133 | + ui.goto_screen([]{ |
| 134 | + _lcd_draw_homing(); |
| 135 | + if (all_axes_homed()) { |
| 136 | + ui.goto_screen(probe_offset_wizard_menu); |
| 137 | + ui.defer_status_screen(); |
| 138 | + } |
| 139 | + }); |
| 140 | +} |
| 141 | + |
| 142 | +#endif // PROBE_OFFSET_WIZARD |
0 commit comments