123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112 |
- /**
- * 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_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 "../../../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_LCD_PROUI && HAS_MESH
|