mirror of
https://github.com/MarlinFirmware/Marlin.git
synced 2025-03-29 17:39:02 +00:00
112 lines
4.2 KiB
C++
112 lines
4.2 KiB
C++
/**
|
|
* Marlin 3D Printer Firmware
|
|
* Copyright (c) 2021 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/>.
|
|
*
|
|
*/
|
|
|
|
/**
|
|
* DWIN Mesh Viewer
|
|
* Author: Miguel A. Risco-Castillo (MRISCOC)
|
|
* Version: 3.9.1
|
|
* Date: 2021/11/09
|
|
*
|
|
* Based on the original code provided by Creality under GPL
|
|
*/
|
|
|
|
#include "../../../inc/MarlinConfigPre.h"
|
|
|
|
#if BOTH(DWIN_CREALITY_LCD_ENHANCED, HAS_MESH)
|
|
|
|
#include "meshviewer.h"
|
|
|
|
#include "../../../core/types.h"
|
|
#include "../../marlinui.h"
|
|
#include "dwin_lcd.h"
|
|
#include "dwinui.h"
|
|
#include "dwin.h"
|
|
#include "../../../feature/bedlevel/bedlevel.h"
|
|
|
|
MeshViewerClass MeshViewer;
|
|
|
|
void MeshViewerClass::Draw() {
|
|
const int8_t mx = 25, my = 25; // Margins
|
|
const int16_t stx = (DWIN_WIDTH - 2 * mx) / (GRID_MAX_POINTS_X - 1), // Steps
|
|
sty = (DWIN_WIDTH - 2 * my) / (GRID_MAX_POINTS_Y - 1);
|
|
const int8_t rmax = _MIN(mx - 2, stx / 2);
|
|
const int8_t rmin = 7;
|
|
int16_t zmesh[GRID_MAX_POINTS_X][GRID_MAX_POINTS_Y], maxz =-32000, minz = 32000;
|
|
#define px(xp) (mx + (xp) * stx)
|
|
#define py(yp) (30 + DWIN_WIDTH - my - (yp) * sty)
|
|
#define rm(z) ((z - minz) * (rmax - rmin) / _MAX(1, (maxz - minz)) + rmin)
|
|
#define DrawMeshValue(xp, yp, zv) DWINUI::Draw_Signed_Float(font6x12, 1, 2, px(xp) - 12, py(yp) - 6, zv)
|
|
#define DrawMeshHLine(yp) DWIN_Draw_HLine(HMI_data.SplitLine_Color, px(0), py(yp), DWIN_WIDTH - 2 * mx)
|
|
#define DrawMeshVLine(xp) DWIN_Draw_VLine(HMI_data.SplitLine_Color, px(xp), py(GRID_MAX_POINTS_Y - 1), DWIN_WIDTH - 2 * my)
|
|
GRID_LOOP(x, y) {
|
|
const float v = isnan(Z_VALUES(x,y)) ? 0 : round(Z_VALUES(x,y) * 100);
|
|
zmesh[x][y] = v;
|
|
NOLESS(maxz, v);
|
|
NOMORE(minz, v);
|
|
}
|
|
Title.ShowCaption(F("Mesh Viewer"));
|
|
DWINUI::ClearMenuArea();
|
|
DWINUI::Draw_Icon(ICON_Continue_E, 86, 305);
|
|
DWIN_Draw_Rectangle(0, HMI_data.SplitLine_Color, px(0), py(0), px(GRID_MAX_POINTS_X - 1), py(GRID_MAX_POINTS_Y - 1));
|
|
LOOP_S_L_N(x, 1, GRID_MAX_POINTS_X - 1) DrawMeshVLine(x);
|
|
LOOP_S_L_N(y, 1, GRID_MAX_POINTS_Y - 1) DrawMeshHLine(y);
|
|
LOOP_L_N(y, GRID_MAX_POINTS_Y) {
|
|
watchdog_refresh();
|
|
LOOP_L_N(x, GRID_MAX_POINTS_X) {
|
|
uint16_t color = DWINUI::RainbowInt(zmesh[x][y], _MIN(-5, minz), _MAX(5, maxz));
|
|
uint8_t radius = rm(zmesh[x][y]);
|
|
DWINUI::Draw_FillCircle(color, px(x), py(y), radius);
|
|
if (GRID_MAX_POINTS_X < 9)
|
|
DWINUI::Draw_Signed_Float(font6x12, 1, 2, px(x) - 12, py(y) - 6, Z_VALUES(x,y));
|
|
else {
|
|
char str_1[9];
|
|
str_1[0] = 0;
|
|
switch (zmesh[x][y]) {
|
|
case -999 ... -100:
|
|
DWINUI::Draw_Signed_Float(font6x12, 1, 1, px(x) - 12, py(y) - 6, Z_VALUES(x,y));
|
|
break;
|
|
case -99 ... -1:
|
|
sprintf_P(str_1, PSTR("-.%02i"), -zmesh[x][y]);
|
|
break;
|
|
case 0:
|
|
DWIN_Draw_String(false, font6x12, DWINUI::textcolor, DWINUI::backcolor, px(x) - 4, py(y) - 6, "0");;
|
|
break;
|
|
case 1 ... 99:
|
|
sprintf_P(str_1, PSTR(".%02i"), zmesh[x][y]);
|
|
break;
|
|
case 100 ... 999:
|
|
DWINUI::Draw_Signed_Float(font6x12, 1, 1, px(x) - 12, py(y) - 6, Z_VALUES(x,y));
|
|
break;
|
|
}
|
|
if (str_1[0])
|
|
DWIN_Draw_String(false, font6x12, DWINUI::textcolor, DWINUI::backcolor, px(x) - 12, py(y) - 6, str_1);
|
|
}
|
|
}
|
|
}
|
|
char str_1[6], str_2[6] = "";
|
|
ui.status_printf(0, F("Mesh minZ: %s, maxZ: %s"),
|
|
dtostrf((float)minz / 100, 1, 2, str_1),
|
|
dtostrf((float)maxz / 100, 1, 2, str_2)
|
|
);
|
|
}
|
|
|
|
#endif // DWIN_CREALITY_LCD_ENHANCED && HAS_MESH
|