129 lines
4.7 KiB
C++
129 lines
4.7 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/>.
|
|
*
|
|
*/
|
|
|
|
/**
|
|
* Mesh Viewer for PRO UI
|
|
* Author: Miguel A. Risco-Castillo (MRISCOC)
|
|
* version: 3.12.1
|
|
* Date: 2022/02/24
|
|
*/
|
|
|
|
#include "../../../inc/MarlinConfigPre.h"
|
|
|
|
#if BOTH(DWIN_LCD_PROUI, HAS_MESH)
|
|
|
|
#include "meshviewer.h"
|
|
|
|
#include "../../../core/types.h"
|
|
#include "../../marlinui.h"
|
|
#include "dwin_lcd.h"
|
|
#include "dwinui.h"
|
|
#include "dwin.h"
|
|
#include "dwin_popup.h"
|
|
#include "../../../feature/bedlevel/bedlevel.h"
|
|
|
|
MeshViewerClass MeshViewer;
|
|
|
|
void MeshViewerClass::DrawMesh(bed_mesh_t zval, const uint8_t sizex, const uint8_t sizey) {
|
|
const int8_t mx = 25, my = 25; // Margins
|
|
const int16_t stx = (DWIN_WIDTH - 2 * mx) / (sizex - 1), // Steps
|
|
sty = (DWIN_WIDTH - 2 * my) / (sizey - 1);
|
|
const int8_t rmax = _MIN(mx - 2, stx / 2);
|
|
const int8_t rmin = 7;
|
|
int16_t zmesh[sizex][sizey];
|
|
#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) - 18, 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(sizey - 1), DWIN_WIDTH - 2 * my)
|
|
int16_t maxz =-32000; int16_t minz = 32000; avg = 0;
|
|
LOOP_L_N(y, sizey) LOOP_L_N(x, sizex) {
|
|
const float v = isnan(zval[x][y]) ? 0 : round(zval[x][y] * 100);
|
|
zmesh[x][y] = v;
|
|
avg += v;
|
|
NOLESS(maxz, v);
|
|
NOMORE(minz, v);
|
|
}
|
|
max = (float)maxz / 100;
|
|
min = (float)minz / 100;
|
|
avg = avg / (100 * sizex * sizey);
|
|
DWINUI::ClearMenuArea();
|
|
DWIN_Draw_Rectangle(0, HMI_data.SplitLine_Color, px(0), py(0), px(sizex - 1), py(sizey - 1));
|
|
LOOP_S_L_N(x, 1, sizex - 1) DrawMeshVLine(x);
|
|
LOOP_S_L_N(y, 1, sizey - 1) DrawMeshHLine(y);
|
|
LOOP_L_N(y, sizey) {
|
|
watchdog_refresh();
|
|
LOOP_L_N(x, sizex) {
|
|
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 (sizex < 9)
|
|
DWINUI::Draw_Signed_Float(font6x12, 1, 2, px(x) - 18, py(y) - 6, zval[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) - 18, py(y) - 6, zval[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) - 18, py(y) - 6, zval[x][y]);
|
|
break;
|
|
}
|
|
if (str_1[0])
|
|
DWIN_Draw_String(false, font6x12, DWINUI::textcolor, DWINUI::backcolor, px(x) - 12, py(y) - 6, str_1);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void MeshViewerClass::Draw(bool withsave /*= false*/) {
|
|
Title.ShowCaption(F("Mesh Viewer"));
|
|
DrawMesh(Z_VALUES_ARR, GRID_MAX_POINTS_X, GRID_MAX_POINTS_Y);
|
|
if (withsave) {
|
|
DWINUI::Draw_Button(BTN_Save, 26, 305);
|
|
DWINUI::Draw_Button(BTN_Continue, 146, 305);
|
|
Draw_Select_Highlight(HMI_flag.select_flag, 305);
|
|
} else DWINUI::Draw_Button(BTN_Continue, 86, 305);
|
|
char str_1[6], str_2[6] = "";
|
|
ui.status_printf(0, F("Mesh minZ: %s, maxZ: %s"),
|
|
dtostrf(min, 1, 2, str_1),
|
|
dtostrf(max, 1, 2, str_2)
|
|
);
|
|
}
|
|
|
|
void Draw_MeshViewer() { MeshViewer.Draw(true); }
|
|
void onClick_MeshViewer() { if (HMI_flag.select_flag) WriteEeprom(); HMI_ReturnScreen(); }
|
|
void Goto_MeshViewer() { if (leveling_is_valid()) Goto_Popup(Draw_MeshViewer, onClick_MeshViewer); else HMI_ReturnScreen(); }
|
|
|
|
#endif // DWIN_LCD_PROUI && HAS_MESH
|