Scott Lahteine
3 years ago
24 changed files with 1623 additions and 969 deletions
File diff suppressed because it is too large
@ -0,0 +1,255 @@ |
|||
/**
|
|||
* UBL Tools and Mesh Viewer for Pro UI |
|||
* Version: 1.0.0 |
|||
* Date: 2022/04/13 |
|||
* |
|||
* Original Author: Henri-J-Norden |
|||
* Original Source: https://github.com/Jyers/Marlin/pull/126
|
|||
* |
|||
* This program is free software: you can redistribute it and/or modify |
|||
* it under the terms of the GNU General Public License as published by |
|||
* the Free Software Foundation, either version 3 of the License, or |
|||
* (at your option) any later version. |
|||
* |
|||
* This program is distributed in the hope that it will be useful, |
|||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|||
* GNU General Public License for more details. |
|||
* |
|||
* You should have received a copy of the GNU General Public License |
|||
* along with this program. If not, see <https://www.gnu.org/licenses/>.
|
|||
* |
|||
*/ |
|||
|
|||
#include "../../../inc/MarlinConfigPre.h" |
|||
#include "ubl_tools.h" |
|||
|
|||
#if ENABLED(DWIN_LCD_PROUI) |
|||
|
|||
#include "../../marlinui.h" |
|||
#include "../../../core/types.h" |
|||
#include "dwin.h" |
|||
#include "dwinui.h" |
|||
#include "dwin_popup.h" |
|||
#include "../../../feature/bedlevel/bedlevel.h" |
|||
#include "../../../module/probe.h" |
|||
#include "../../../gcode/gcode.h" |
|||
#include "../../../module/planner.h" |
|||
#include "../../../gcode/queue.h" |
|||
#include "../../../libs/least_squares_fit.h" |
|||
#include "../../../libs/vector_3.h" |
|||
|
|||
UBLMeshToolsClass ubl_tools; |
|||
|
|||
#if ENABLED(USE_UBL_VIEWER) |
|||
bool UBLMeshToolsClass::viewer_asymmetric_range = false; |
|||
bool UBLMeshToolsClass::viewer_print_value = false; |
|||
#endif |
|||
bool UBLMeshToolsClass::goto_mesh_value = false; |
|||
uint8_t UBLMeshToolsClass::tilt_grid = 1; |
|||
|
|||
bool drawing_mesh = false; |
|||
char cmd[MAX_CMD_SIZE+16], str_1[16], str_2[16], str_3[16]; |
|||
|
|||
#if ENABLED(AUTO_BED_LEVELING_UBL) |
|||
|
|||
void UBLMeshToolsClass::manual_value_update(const uint8_t mesh_x, const uint8_t mesh_y, bool undefined/*=false*/) { |
|||
sprintf_P(cmd, PSTR("M421 I%i J%i Z%s %s"), mesh_x, mesh_y, dtostrf(current_position.z, 1, 3, str_1), undefined ? "N" : ""); |
|||
gcode.process_subcommands_now(cmd); |
|||
planner.synchronize(); |
|||
} |
|||
|
|||
bool UBLMeshToolsClass::create_plane_from_mesh() { |
|||
struct linear_fit_data lsf_results; |
|||
incremental_LSF_reset(&lsf_results); |
|||
GRID_LOOP(x, y) { |
|||
if (!isnan(Z_VALUES_ARR[x][y])) { |
|||
xy_pos_t rpos; |
|||
rpos.x = ubl.mesh_index_to_xpos(x); |
|||
rpos.y = ubl.mesh_index_to_ypos(y); |
|||
incremental_LSF(&lsf_results, rpos, Z_VALUES_ARR[x][y]); |
|||
} |
|||
} |
|||
|
|||
if (finish_incremental_LSF(&lsf_results)) { |
|||
SERIAL_ECHOPGM("Could not complete LSF!"); |
|||
return true; |
|||
} |
|||
|
|||
ubl.set_all_mesh_points_to_value(0); |
|||
|
|||
matrix_3x3 rotation = matrix_3x3::create_look_at(vector_3(lsf_results.A, lsf_results.B, 1)); |
|||
GRID_LOOP(i, j) { |
|||
float mx = ubl.mesh_index_to_xpos(i), |
|||
my = ubl.mesh_index_to_ypos(j), |
|||
mz = Z_VALUES_ARR[i][j]; |
|||
|
|||
if (DEBUGGING(LEVELING)) { |
|||
DEBUG_ECHOPAIR_F("before rotation = [", mx, 7); |
|||
DEBUG_CHAR(','); |
|||
DEBUG_ECHO_F(my, 7); |
|||
DEBUG_CHAR(','); |
|||
DEBUG_ECHO_F(mz, 7); |
|||
DEBUG_ECHOPGM("] ---> "); |
|||
DEBUG_DELAY(20); |
|||
} |
|||
|
|||
rotation.apply_rotation_xyz(mx, my, mz); |
|||
|
|||
if (DEBUGGING(LEVELING)) { |
|||
DEBUG_ECHOPAIR_F("after rotation = [", mx, 7); |
|||
DEBUG_CHAR(','); |
|||
DEBUG_ECHO_F(my, 7); |
|||
DEBUG_CHAR(','); |
|||
DEBUG_ECHO_F(mz, 7); |
|||
DEBUG_ECHOLNPGM("]"); |
|||
DEBUG_DELAY(20); |
|||
} |
|||
|
|||
Z_VALUES_ARR[i][j] = mz - lsf_results.D; |
|||
} |
|||
return false; |
|||
} |
|||
|
|||
#else |
|||
|
|||
void UBLMeshToolsClass::manual_value_update(const uint8_t mesh_x, const uint8_t mesh_y) { |
|||
sprintf_P(cmd, PSTR("G29 I%i J%i Z%s"), mesh_x, mesh_y, dtostrf(current_position.z, 1, 3, str_1)); |
|||
gcode.process_subcommands_now(cmd); |
|||
planner.synchronize(); |
|||
} |
|||
|
|||
#endif |
|||
|
|||
void UBLMeshToolsClass::manual_move(const uint8_t mesh_x, const uint8_t mesh_y, bool zmove/*=false*/) { |
|||
if (zmove) { |
|||
planner.synchronize(); |
|||
current_position.z = goto_mesh_value ? Z_VALUES_ARR[mesh_x][mesh_y] : Z_CLEARANCE_BETWEEN_PROBES; |
|||
planner.buffer_line(current_position, homing_feedrate(Z_AXIS), active_extruder); |
|||
planner.synchronize(); |
|||
} |
|||
else { |
|||
DWIN_Show_Popup(ICON_BLTouch, F("Moving to Point"), F("Please wait until done.")); |
|||
HMI_SaveProcessID(NothingToDo); |
|||
sprintf_P(cmd, PSTR("G0 F300 Z%s"), dtostrf(Z_CLEARANCE_BETWEEN_PROBES, 1, 3, str_1)); |
|||
gcode.process_subcommands_now(cmd); |
|||
sprintf_P(cmd, PSTR("G42 F4000 I%i J%i"), mesh_x, mesh_y); |
|||
gcode.process_subcommands_now(cmd); |
|||
planner.synchronize(); |
|||
current_position.z = goto_mesh_value ? Z_VALUES_ARR[mesh_x][mesh_y] : Z_CLEARANCE_BETWEEN_PROBES; |
|||
planner.buffer_line(current_position, homing_feedrate(Z_AXIS), active_extruder); |
|||
planner.synchronize(); |
|||
HMI_ReturnScreen(); |
|||
} |
|||
} |
|||
|
|||
float UBLMeshToolsClass::get_max_value() { |
|||
float max = __FLT_MIN__; |
|||
GRID_LOOP(x, y) { |
|||
if (!isnan(Z_VALUES_ARR[x][y]) && Z_VALUES_ARR[x][y] > max) |
|||
max = Z_VALUES_ARR[x][y]; |
|||
} |
|||
return max; |
|||
} |
|||
|
|||
float UBLMeshToolsClass::get_min_value() { |
|||
float min = __FLT_MAX__; |
|||
GRID_LOOP(x, y) { |
|||
if (!isnan(Z_VALUES_ARR[x][y]) && Z_VALUES_ARR[x][y] < min) |
|||
min = Z_VALUES_ARR[x][y]; |
|||
} |
|||
return min; |
|||
} |
|||
|
|||
bool UBLMeshToolsClass::validate() { |
|||
float min = __FLT_MAX__; |
|||
float max = __FLT_MIN__; |
|||
|
|||
GRID_LOOP(x, y) { |
|||
if (isnan(Z_VALUES_ARR[x][y])) return false; |
|||
if (Z_VALUES_ARR[x][y] < min) min = Z_VALUES_ARR[x][y]; |
|||
if (Z_VALUES_ARR[x][y] > max) max = Z_VALUES_ARR[x][y]; |
|||
} |
|||
return max <= UBL_Z_OFFSET_MAX && min >= UBL_Z_OFFSET_MIN; |
|||
} |
|||
|
|||
#if ENABLED(USE_UBL_VIEWER) |
|||
void UBLMeshToolsClass::Draw_Bed_Mesh(int16_t selected /*= -1*/, uint8_t gridline_width /*= 1*/, uint16_t padding_x /*= 8*/, uint16_t padding_y_top /*= 40 + 53 - 7*/) { |
|||
drawing_mesh = true; |
|||
const uint16_t total_width_px = DWIN_WIDTH - padding_x - padding_x; |
|||
const uint16_t cell_width_px = total_width_px / GRID_MAX_POINTS_X; |
|||
const uint16_t cell_height_px = total_width_px / GRID_MAX_POINTS_Y; |
|||
const float v_max = abs(get_max_value()), v_min = abs(get_min_value()), range = _MAX(v_min, v_max); |
|||
|
|||
// Clear background from previous selection and select new square
|
|||
DWIN_Draw_Rectangle(1, Color_Bg_Black, _MAX(0, padding_x - gridline_width), _MAX(0, padding_y_top - gridline_width), padding_x + total_width_px, padding_y_top + total_width_px); |
|||
if (selected >= 0) { |
|||
const auto selected_y = selected / GRID_MAX_POINTS_X; |
|||
const auto selected_x = selected - (GRID_MAX_POINTS_X * selected_y); |
|||
const auto start_y_px = padding_y_top + selected_y * cell_height_px; |
|||
const auto start_x_px = padding_x + selected_x * cell_width_px; |
|||
DWIN_Draw_Rectangle(1, Color_White, _MAX(0, start_x_px - gridline_width), _MAX(0, start_y_px - gridline_width), start_x_px + cell_width_px, start_y_px + cell_height_px); |
|||
} |
|||
|
|||
// Draw value square grid
|
|||
char buf[8]; |
|||
GRID_LOOP(x, y) { |
|||
const auto start_x_px = padding_x + x * cell_width_px; |
|||
const auto end_x_px = start_x_px + cell_width_px - 1 - gridline_width; |
|||
const auto start_y_px = padding_y_top + (GRID_MAX_POINTS_Y - y - 1) * cell_height_px; |
|||
const auto end_y_px = start_y_px + cell_height_px - 1 - gridline_width; |
|||
DWIN_Draw_Rectangle(1, // RGB565 colors: http://www.barth-dev.de/online/rgb565-color-picker/
|
|||
isnan(Z_VALUES_ARR[x][y]) ? Color_Grey : ( // gray if undefined
|
|||
(Z_VALUES_ARR[x][y] < 0 ? |
|||
(uint16_t)round(0x1F * -Z_VALUES_ARR[x][y] / (!viewer_asymmetric_range ? range : v_min)) << 11 : // red if mesh point value is negative
|
|||
(uint16_t)round(0x3F * Z_VALUES_ARR[x][y] / (!viewer_asymmetric_range ? range : v_max)) << 5) | // green if mesh point value is positive
|
|||
_MIN(0x1F, (((uint8_t)abs(Z_VALUES_ARR[x][y]) / 10) * 4))), // + blue stepping for every mm
|
|||
start_x_px, start_y_px, end_x_px, end_y_px |
|||
); |
|||
|
|||
safe_delay(10); |
|||
LCD_SERIAL.flushTX(); |
|||
|
|||
// Draw value text on
|
|||
if (viewer_print_value) { |
|||
int8_t offset_x, offset_y = cell_height_px / 2 - 6; |
|||
if (isnan(Z_VALUES_ARR[x][y])) { // undefined
|
|||
DWIN_Draw_String(false, font6x12, Color_White, Color_Bg_Blue, start_x_px + cell_width_px / 2 - 5, start_y_px + offset_y, F("X")); |
|||
} |
|||
else { // has value
|
|||
if (GRID_MAX_POINTS_X < 10) |
|||
sprintf_P(buf, PSTR("%s"), dtostrf(abs(Z_VALUES_ARR[x][y]), 1, 2, str_1)); |
|||
else |
|||
sprintf_P(buf, PSTR("%02i"), (uint16_t)(abs(Z_VALUES_ARR[x][y] - (int16_t)Z_VALUES_ARR[x][y]) * 100)); |
|||
offset_x = cell_width_px / 2 - 3 * (strlen(buf)) - 2; |
|||
if (!(GRID_MAX_POINTS_X < 10)) |
|||
DWIN_Draw_String(false, font6x12, Color_White, Color_Bg_Blue, start_x_px - 2 + offset_x, start_y_px + offset_y /*+ square / 2 - 6*/, F(".")); |
|||
DWIN_Draw_String(false, font6x12, Color_White, Color_Bg_Blue, start_x_px + 1 + offset_x, start_y_px + offset_y /*+ square / 2 - 6*/, buf); |
|||
} |
|||
safe_delay(10); |
|||
LCD_SERIAL.flushTX(); |
|||
} |
|||
} |
|||
} |
|||
|
|||
void UBLMeshToolsClass::Set_Mesh_Viewer_Status() { // TODO: draw gradient with values as a legend instead
|
|||
float v_max = abs(get_max_value()), v_min = abs(get_min_value()), range = _MAX(v_min, v_max); |
|||
if (v_min > 3e+10F) v_min = 0.0000001; |
|||
if (v_max > 3e+10F) v_max = 0.0000001; |
|||
if (range > 3e+10F) range = 0.0000001; |
|||
char msg[46]; |
|||
if (viewer_asymmetric_range) { |
|||
dtostrf(-v_min, 1, 3, str_1); |
|||
dtostrf( v_max, 1, 3, str_2); |
|||
} |
|||
else { |
|||
dtostrf(-range, 1, 3, str_1); |
|||
dtostrf( range, 1, 3, str_2); |
|||
} |
|||
sprintf_P(msg, PSTR("Red %s..0..%s Green"), str_1, str_2); |
|||
ui.set_status(msg); |
|||
drawing_mesh = false; |
|||
} |
|||
#endif |
|||
|
|||
#endif // DWIN_LCD_PROUI
|
@ -0,0 +1,59 @@ |
|||
/**
|
|||
* UBL Tools and Mesh Viewer for Pro UI |
|||
* Version: 1.0.0 |
|||
* Date: 2022/04/13 |
|||
* |
|||
* Original Author: Henri-J-Norden (https://github.com/Henri-J-Norden)
|
|||
* Original Source: https://github.com/Jyers/Marlin/pull/135
|
|||
* |
|||
* This program is free software: you can redistribute it and/or modify |
|||
* it under the terms of the GNU General Public License as published by |
|||
* the Free Software Foundation, either version 3 of the License, or |
|||
* (at your option) any later version. |
|||
* |
|||
* This program is distributed in the hope that it will be useful, |
|||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|||
* GNU General Public License for more details. |
|||
* |
|||
* You should have received a copy of the GNU General Public License |
|||
* along with this program. If not, see <https://www.gnu.org/licenses/>.
|
|||
* |
|||
*/ |
|||
#pragma once |
|||
|
|||
#include "../../../inc/MarlinConfigPre.h" |
|||
|
|||
//#define USE_UBL_VIEWER 1
|
|||
|
|||
#define UBL_Z_OFFSET_MIN -3.0 |
|||
#define UBL_Z_OFFSET_MAX 3.0 |
|||
|
|||
class UBLMeshToolsClass { |
|||
public: |
|||
#if ENABLED(USE_UBL_VIEWER) |
|||
static bool viewer_asymmetric_range; |
|||
static bool viewer_print_value; |
|||
#endif |
|||
static bool goto_mesh_value; |
|||
static uint8_t tilt_grid; |
|||
|
|||
#if ENABLED(AUTO_BED_LEVELING_UBL) |
|||
static void manual_value_update(const uint8_t mesh_x, const uint8_t mesh_y, bool undefined=false); |
|||
static bool create_plane_from_mesh(); |
|||
#else |
|||
static void manual_value_update(const uint8_t mesh_x, const uint8_t mesh_y); |
|||
#endif |
|||
static void manual_move(const uint8_t mesh_x, const uint8_t mesh_y, bool zmove=false); |
|||
static float get_max_value(); |
|||
static float get_min_value(); |
|||
static bool validate(); |
|||
#if ENABLED(USE_UBL_VIEWER) |
|||
static void Draw_Bed_Mesh(int16_t selected = -1, uint8_t gridline_width = 1, uint16_t padding_x = 8, uint16_t padding_y_top = 40 + 53 - 7); |
|||
static void Set_Mesh_Viewer_Status(); |
|||
#endif |
|||
}; |
|||
|
|||
extern UBLMeshToolsClass ubl_tools; |
|||
|
|||
void Goto_MeshViewer(); |
Loading…
Reference in new issue