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