|
|
@ -39,8 +39,10 @@
|
|
|
|
//#define DEBUG_OUT 1
|
|
|
|
//#define DEBUG_OUT 1
|
|
|
|
#include "../../core/debug_out.h"
|
|
|
|
#include "../../core/debug_out.h"
|
|
|
|
|
|
|
|
|
|
|
|
float z_measured[G35_PROBE_COUNT] = { 0 };
|
|
|
|
static float z_measured[G35_PROBE_COUNT];
|
|
|
|
|
|
|
|
static bool z_isvalid[G35_PROBE_COUNT];
|
|
|
|
static uint8_t tram_index = 0;
|
|
|
|
static uint8_t tram_index = 0;
|
|
|
|
|
|
|
|
static int8_t reference_index; // = 0
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
#if HAS_LEVELING
|
|
|
|
#include "../../feature/bedlevel/bedlevel.h"
|
|
|
|
#include "../../feature/bedlevel/bedlevel.h"
|
|
|
@ -50,32 +52,31 @@ static bool probe_single_point() {
|
|
|
|
do_blocking_move_to_z(TERN(BLTOUCH, Z_CLEARANCE_DEPLOY_PROBE, Z_CLEARANCE_BETWEEN_PROBES));
|
|
|
|
do_blocking_move_to_z(TERN(BLTOUCH, Z_CLEARANCE_DEPLOY_PROBE, Z_CLEARANCE_BETWEEN_PROBES));
|
|
|
|
// Stow after each point with BLTouch "HIGH SPEED" mode for push-pin safety
|
|
|
|
// Stow after each point with BLTouch "HIGH SPEED" mode for push-pin safety
|
|
|
|
const float z_probed_height = probe.probe_at_point(tramming_points[tram_index], TERN(BLTOUCH_HS_MODE, PROBE_PT_STOW, PROBE_PT_RAISE), 0, true);
|
|
|
|
const float z_probed_height = probe.probe_at_point(tramming_points[tram_index], TERN(BLTOUCH_HS_MODE, PROBE_PT_STOW, PROBE_PT_RAISE), 0, true);
|
|
|
|
DEBUG_ECHOLNPAIR("probe_single_point: ", z_probed_height, "mm");
|
|
|
|
|
|
|
|
z_measured[tram_index] = z_probed_height;
|
|
|
|
z_measured[tram_index] = z_probed_height;
|
|
|
|
|
|
|
|
if (reference_index < 0) reference_index = tram_index;
|
|
|
|
move_to_tramming_wait_pos();
|
|
|
|
move_to_tramming_wait_pos();
|
|
|
|
|
|
|
|
|
|
|
|
return !isnan(z_probed_height);
|
|
|
|
DEBUG_ECHOLNPAIR("probe_single_point(", tram_index, ") = ", z_probed_height, "mm");
|
|
|
|
|
|
|
|
return (z_isvalid[tram_index] = !isnan(z_probed_height));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void _menu_single_probe(const uint8_t point) {
|
|
|
|
static void _menu_single_probe() {
|
|
|
|
tram_index = point;
|
|
|
|
DEBUG_ECHOLNPAIR("Screen: single probe screen Arg:", tram_index);
|
|
|
|
DEBUG_ECHOLNPAIR("Screen: single probe screen Arg:", point);
|
|
|
|
|
|
|
|
START_MENU();
|
|
|
|
START_MENU();
|
|
|
|
STATIC_ITEM(MSG_BED_TRAMMING, SS_LEFT);
|
|
|
|
STATIC_ITEM(MSG_BED_TRAMMING, SS_LEFT);
|
|
|
|
STATIC_ITEM(MSG_LAST_VALUE_SP, SS_LEFT, ftostr42_52(z_measured[0] - z_measured[point])); // Print diff
|
|
|
|
STATIC_ITEM(MSG_LAST_VALUE_SP, SS_LEFT, z_isvalid[tram_index] ? ftostr42_52(z_measured[reference_index] - z_measured[tram_index]) : "---");
|
|
|
|
ACTION_ITEM(MSG_UBL_BC_INSERT2, []{ if (probe_single_point()) ui.refresh(); });
|
|
|
|
ACTION_ITEM(MSG_UBL_BC_INSERT2, []{ if (probe_single_point()) ui.refresh(); });
|
|
|
|
ACTION_ITEM(MSG_BUTTON_DONE, []{ ui.goto_previous_screen(); }); // Back
|
|
|
|
ACTION_ITEM(MSG_BUTTON_DONE, []{ ui.goto_previous_screen(); });
|
|
|
|
END_MENU();
|
|
|
|
END_MENU();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void tramming_wizard_menu() {
|
|
|
|
static void tramming_wizard_menu() {
|
|
|
|
DEBUG_ECHOLNPAIR("Screen: tramming_wizard_menu");
|
|
|
|
|
|
|
|
START_MENU();
|
|
|
|
START_MENU();
|
|
|
|
STATIC_ITEM(MSG_SELECT_ORIGIN);
|
|
|
|
STATIC_ITEM(MSG_SELECT_ORIGIN);
|
|
|
|
|
|
|
|
|
|
|
|
// Draw a menu item for each tramming point
|
|
|
|
// Draw a menu item for each tramming point
|
|
|
|
LOOP_L_N(i, G35_PROBE_COUNT)
|
|
|
|
for (tram_index = 0; tram_index < G35_PROBE_COUNT; tram_index++)
|
|
|
|
SUBMENU_N_P(i, (char*)pgm_read_ptr(&tramming_point_name[i]), []{ _menu_single_probe(MenuItemBase::itemIndex); });
|
|
|
|
SUBMENU_P((char*)pgm_read_ptr(&tramming_point_name[tram_index]), _menu_single_probe);
|
|
|
|
|
|
|
|
|
|
|
|
ACTION_ITEM(MSG_BUTTON_DONE, []{
|
|
|
|
ACTION_ITEM(MSG_BUTTON_DONE, []{
|
|
|
|
probe.stow(); // Stow before exiting Tramming Wizard
|
|
|
|
probe.stow(); // Stow before exiting Tramming Wizard
|
|
|
@ -87,9 +88,12 @@ static void tramming_wizard_menu() {
|
|
|
|
// Init the wizard and enter the submenu
|
|
|
|
// Init the wizard and enter the submenu
|
|
|
|
void goto_tramming_wizard() {
|
|
|
|
void goto_tramming_wizard() {
|
|
|
|
DEBUG_ECHOLNPAIR("Screen: goto_tramming_wizard", 1);
|
|
|
|
DEBUG_ECHOLNPAIR("Screen: goto_tramming_wizard", 1);
|
|
|
|
tram_index = 0;
|
|
|
|
|
|
|
|
ui.defer_status_screen();
|
|
|
|
ui.defer_status_screen();
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Initialize measured point flags
|
|
|
|
|
|
|
|
ZERO(z_isvalid);
|
|
|
|
|
|
|
|
reference_index = -1;
|
|
|
|
|
|
|
|
|
|
|
|
// Inject G28, wait for homing to complete,
|
|
|
|
// Inject G28, wait for homing to complete,
|
|
|
|
set_all_unhomed();
|
|
|
|
set_all_unhomed();
|
|
|
|
queue.inject_P(TERN(CAN_SET_LEVELING_AFTER_G28, PSTR("G28L0"), G28_STR));
|
|
|
|
queue.inject_P(TERN(CAN_SET_LEVELING_AFTER_G28, PSTR("G28L0"), G28_STR));
|
|
|
|