123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260 |
- /**
- * Marlin 3D Printer Firmware
- * Copyright (c) 2022 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
- *
- * Based on Sprinter and grbl.
- * Copyright (c) 2011 Camiel Gubbels / Erik van der Zalm
- *
- * 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/>.
- *
- */
-
- /**
- * 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
- */
-
- #include "../../../inc/MarlinConfigPre.h"
-
- #if BOTH(DWIN_LCD_PROUI, AUTO_BED_LEVELING_UBL)
-
- #include "ubl_tools.h"
- #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(bedlevel.z_values[x][y])) {
- xy_pos_t rpos = { bedlevel.get_mesh_x(x), bedlevel.get_mesh_y(y) };
- incremental_LSF(&lsf_results, rpos, bedlevel.z_values[x][y]);
- }
- }
-
- if (finish_incremental_LSF(&lsf_results)) {
- SERIAL_ECHOPGM("Could not complete LSF!");
- return true;
- }
-
- bedlevel.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 = bedlevel.get_mesh_x(i),
- my = bedlevel.get_mesh_y(j),
- mz = bedlevel.z_values[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);
- }
-
- bedlevel.z_values[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 ? bedlevel.z_values[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 ? bedlevel.z_values[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(bedlevel.z_values[x][y]) && bedlevel.z_values[x][y] > max)
- max = bedlevel.z_values[x][y];
- }
- return max;
- }
-
- float UBLMeshToolsClass::get_min_value() {
- float min = __FLT_MAX__;
- GRID_LOOP(x, y) {
- if (!isnan(bedlevel.z_values[x][y]) && bedlevel.z_values[x][y] < min)
- min = bedlevel.z_values[x][y];
- }
- return min;
- }
-
- bool UBLMeshToolsClass::validate() {
- float min = __FLT_MAX__, max = __FLT_MIN__;
-
- GRID_LOOP(x, y) {
- if (isnan(bedlevel.z_values[x][y])) return false;
- if (bedlevel.z_values[x][y] < min) min = bedlevel.z_values[x][y];
- if (bedlevel.z_values[x][y] > max) max = bedlevel.z_values[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(bedlevel.z_values[x][y]) ? Color_Grey : ( // gray if undefined
- (bedlevel.z_values[x][y] < 0 ?
- (uint16_t)round(0x1F * -bedlevel.z_values[x][y] / (!viewer_asymmetric_range ? range : v_min)) << 11 : // red if mesh point value is negative
- (uint16_t)round(0x3F * bedlevel.z_values[x][y] / (!viewer_asymmetric_range ? range : v_max)) << 5) | // green if mesh point value is positive
- _MIN(0x1F, (((uint8_t)abs(bedlevel.z_values[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(bedlevel.z_values[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(bedlevel.z_values[x][y]), 1, 2, str_1));
- else
- sprintf_P(buf, PSTR("%02i"), (uint16_t)(abs(bedlevel.z_values[x][y] - (int16_t)bedlevel.z_values[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 && AUTO_BED_LEVELING_UBL
|