|
@@ -39,8 +39,10 @@
|
39
|
39
|
//#define DEBUG_OUT 1
|
40
|
40
|
#include "../../core/debug_out.h"
|
41
|
41
|
|
42
|
|
-float z_measured[G35_PROBE_COUNT] = { 0 };
|
|
42
|
+static float z_measured[G35_PROBE_COUNT];
|
|
43
|
+static bool z_isvalid[G35_PROBE_COUNT];
|
43
|
44
|
static uint8_t tram_index = 0;
|
|
45
|
+static int8_t reference_index; // = 0
|
44
|
46
|
|
45
|
47
|
#if HAS_LEVELING
|
46
|
48
|
#include "../../feature/bedlevel/bedlevel.h"
|
|
@@ -50,32 +52,31 @@ static bool probe_single_point() {
|
50
|
52
|
do_blocking_move_to_z(TERN(BLTOUCH, Z_CLEARANCE_DEPLOY_PROBE, Z_CLEARANCE_BETWEEN_PROBES));
|
51
|
53
|
// Stow after each point with BLTouch "HIGH SPEED" mode for push-pin safety
|
52
|
54
|
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);
|
53
|
|
- DEBUG_ECHOLNPAIR("probe_single_point: ", z_probed_height, "mm");
|
54
|
55
|
z_measured[tram_index] = z_probed_height;
|
|
56
|
+ if (reference_index < 0) reference_index = tram_index;
|
55
|
57
|
move_to_tramming_wait_pos();
|
56
|
58
|
|
57
|
|
- return !isnan(z_probed_height);
|
|
59
|
+ DEBUG_ECHOLNPAIR("probe_single_point(", tram_index, ") = ", z_probed_height, "mm");
|
|
60
|
+ return (z_isvalid[tram_index] = !isnan(z_probed_height));
|
58
|
61
|
}
|
59
|
62
|
|
60
|
|
-static void _menu_single_probe(const uint8_t point) {
|
61
|
|
- tram_index = point;
|
62
|
|
- DEBUG_ECHOLNPAIR("Screen: single probe screen Arg:", point);
|
|
63
|
+static void _menu_single_probe() {
|
|
64
|
+ DEBUG_ECHOLNPAIR("Screen: single probe screen Arg:", tram_index);
|
63
|
65
|
START_MENU();
|
64
|
66
|
STATIC_ITEM(MSG_BED_TRAMMING, SS_LEFT);
|
65
|
|
- STATIC_ITEM(MSG_LAST_VALUE_SP, SS_LEFT, ftostr42_52(z_measured[0] - z_measured[point])); // Print diff
|
|
67
|
+ STATIC_ITEM(MSG_LAST_VALUE_SP, SS_LEFT, z_isvalid[tram_index] ? ftostr42_52(z_measured[reference_index] - z_measured[tram_index]) : "---");
|
66
|
68
|
ACTION_ITEM(MSG_UBL_BC_INSERT2, []{ if (probe_single_point()) ui.refresh(); });
|
67
|
|
- ACTION_ITEM(MSG_BUTTON_DONE, []{ ui.goto_previous_screen(); }); // Back
|
|
69
|
+ ACTION_ITEM(MSG_BUTTON_DONE, []{ ui.goto_previous_screen(); });
|
68
|
70
|
END_MENU();
|
69
|
71
|
}
|
70
|
72
|
|
71
|
73
|
static void tramming_wizard_menu() {
|
72
|
|
- DEBUG_ECHOLNPAIR("Screen: tramming_wizard_menu");
|
73
|
74
|
START_MENU();
|
74
|
75
|
STATIC_ITEM(MSG_SELECT_ORIGIN);
|
75
|
76
|
|
76
|
77
|
// Draw a menu item for each tramming point
|
77
|
|
- LOOP_L_N(i, G35_PROBE_COUNT)
|
78
|
|
- SUBMENU_N_P(i, (char*)pgm_read_ptr(&tramming_point_name[i]), []{ _menu_single_probe(MenuItemBase::itemIndex); });
|
|
78
|
+ for (tram_index = 0; tram_index < G35_PROBE_COUNT; tram_index++)
|
|
79
|
+ SUBMENU_P((char*)pgm_read_ptr(&tramming_point_name[tram_index]), _menu_single_probe);
|
79
|
80
|
|
80
|
81
|
ACTION_ITEM(MSG_BUTTON_DONE, []{
|
81
|
82
|
probe.stow(); // Stow before exiting Tramming Wizard
|
|
@@ -87,9 +88,12 @@ static void tramming_wizard_menu() {
|
87
|
88
|
// Init the wizard and enter the submenu
|
88
|
89
|
void goto_tramming_wizard() {
|
89
|
90
|
DEBUG_ECHOLNPAIR("Screen: goto_tramming_wizard", 1);
|
90
|
|
- tram_index = 0;
|
91
|
91
|
ui.defer_status_screen();
|
92
|
92
|
|
|
93
|
+ // Initialize measured point flags
|
|
94
|
+ ZERO(z_isvalid);
|
|
95
|
+ reference_index = -1;
|
|
96
|
+
|
93
|
97
|
// Inject G28, wait for homing to complete,
|
94
|
98
|
set_all_unhomed();
|
95
|
99
|
queue.inject_P(TERN(CAN_SET_LEVELING_AFTER_G28, PSTR("G28L0"), G28_STR));
|