123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261 |
- /**
- * Marlin 3D Printer Firmware
- * Copyright (c) 2020 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/>.
- *
- */
-
- #include "../../inc/MarlinConfig.h"
-
- #if HAS_LEVELING
-
- #include "../gcode.h"
- #include "../../feature/bedlevel/bedlevel.h"
- #include "../../module/planner.h"
- #include "../../module/probe.h"
-
- #if ENABLED(EEPROM_SETTINGS)
- #include "../../module/settings.h"
- #endif
-
- #if ENABLED(EXTENSIBLE_UI)
- #include "../../lcd/extui/ui_api.h"
- #endif
-
- //#define M420_C_USE_MEAN
-
- /**
- * M420: Enable/Disable Bed Leveling and/or set the Z fade height.
- *
- * S[bool] Turns leveling on or off
- * Z[height] Sets the Z fade height (0 or none to disable)
- * V[bool] Verbose - Print the leveling grid
- *
- * With AUTO_BED_LEVELING_UBL only:
- *
- * L[index] Load UBL mesh from index (0 is default)
- * T[map] 0:Human-readable 1:CSV 2:"LCD" 4:Compact
- *
- * With mesh-based leveling only:
- *
- * C Center mesh on the mean of the lowest and highest
- *
- * With MARLIN_DEV_MODE:
- * S2 Create a simple random mesh and enable
- */
- void GcodeSuite::M420() {
- const bool seen_S = parser.seen('S'),
- to_enable = seen_S ? parser.value_bool() : planner.leveling_active;
-
- #if ENABLED(MARLIN_DEV_MODE)
- if (parser.intval('S') == 2) {
- const float x_min = probe.min_x(), x_max = probe.max_x(),
- y_min = probe.min_y(), y_max = probe.max_y();
- #if ENABLED(AUTO_BED_LEVELING_BILINEAR)
- xy_pos_t start, spacing;
- start.set(x_min, y_min);
- spacing.set((x_max - x_min) / (GRID_MAX_CELLS_X),
- (y_max - y_min) / (GRID_MAX_CELLS_Y));
- bedlevel.set_grid(spacing, start);
- #endif
- GRID_LOOP(x, y) {
- bedlevel.z_values[x][y] = 0.001 * random(-200, 200);
- TERN_(EXTENSIBLE_UI, ExtUI::onMeshUpdate(x, y, bedlevel.z_values[x][y]));
- }
- TERN_(AUTO_BED_LEVELING_BILINEAR, bedlevel.refresh_bed_level());
- SERIAL_ECHOPGM("Simulated " STRINGIFY(GRID_MAX_POINTS_X) "x" STRINGIFY(GRID_MAX_POINTS_Y) " mesh ");
- SERIAL_ECHOPGM(" (", x_min);
- SERIAL_CHAR(','); SERIAL_ECHO(y_min);
- SERIAL_ECHOPGM(")-(", x_max);
- SERIAL_CHAR(','); SERIAL_ECHO(y_max);
- SERIAL_ECHOLNPGM(")");
- }
- #endif
-
- xyz_pos_t oldpos = current_position;
-
- // If disabling leveling do it right away
- // (Don't disable for just M420 or M420 V)
- if (seen_S && !to_enable) set_bed_leveling_enabled(false);
-
- #if ENABLED(AUTO_BED_LEVELING_UBL)
-
- // L to load a mesh from the EEPROM
- if (parser.seen('L')) {
-
- set_bed_leveling_enabled(false);
-
- #if ENABLED(EEPROM_SETTINGS)
- const int8_t storage_slot = parser.has_value() ? parser.value_int() : bedlevel.storage_slot;
- const int16_t a = settings.calc_num_meshes();
-
- if (!a) {
- SERIAL_ECHOLNPGM("?EEPROM storage not available.");
- return;
- }
-
- if (!WITHIN(storage_slot, 0, a - 1)) {
- SERIAL_ECHOLNPGM("?Invalid storage slot.");
- SERIAL_ECHOLNPGM("?Use 0 to ", a - 1);
- return;
- }
-
- settings.load_mesh(storage_slot);
- bedlevel.storage_slot = storage_slot;
-
- #else
-
- SERIAL_ECHOLNPGM("?EEPROM storage not available.");
- return;
-
- #endif
- }
-
- // L or V display the map info
- if (parser.seen("LV")) {
- bedlevel.display_map(parser.byteval('T'));
- SERIAL_ECHOPGM("Mesh is ");
- if (!bedlevel.mesh_is_valid()) SERIAL_ECHOPGM("in");
- SERIAL_ECHOLNPGM("valid\nStorage slot: ", bedlevel.storage_slot);
- }
-
- #endif // AUTO_BED_LEVELING_UBL
-
- const bool seenV = parser.seen_test('V');
-
- #if HAS_MESH
-
- if (leveling_is_valid()) {
-
- // Subtract the given value or the mean from all mesh values
- if (parser.seen('C')) {
- const float cval = parser.value_float();
- #if ENABLED(AUTO_BED_LEVELING_UBL)
-
- set_bed_leveling_enabled(false);
- bedlevel.adjust_mesh_to_mean(true, cval);
-
- #else
-
- #if ENABLED(M420_C_USE_MEAN)
-
- // Get the sum and average of all mesh values
- float mesh_sum = 0;
- GRID_LOOP(x, y) mesh_sum += bedlevel.z_values[x][y];
- const float zmean = mesh_sum / float(GRID_MAX_POINTS);
-
- #else // midrange
-
- // Find the low and high mesh values.
- float lo_val = 100, hi_val = -100;
- GRID_LOOP(x, y) {
- const float z = bedlevel.z_values[x][y];
- NOMORE(lo_val, z);
- NOLESS(hi_val, z);
- }
- // Get the midrange plus C value. (The median may be better.)
- const float zmean = (lo_val + hi_val) / 2.0 + cval;
-
- #endif
-
- // If not very close to 0, adjust the mesh
- if (!NEAR_ZERO(zmean)) {
- set_bed_leveling_enabled(false);
- // Subtract the mean from all values
- GRID_LOOP(x, y) {
- bedlevel.z_values[x][y] -= zmean;
- TERN_(EXTENSIBLE_UI, ExtUI::onMeshUpdate(x, y, bedlevel.z_values[x][y]));
- }
- TERN_(AUTO_BED_LEVELING_BILINEAR, bedlevel.refresh_bed_level());
- }
-
- #endif
- }
-
- }
- else if (to_enable || seenV) {
- SERIAL_ECHO_MSG("Invalid mesh.");
- goto EXIT_M420;
- }
-
- #endif // HAS_MESH
-
- // V to print the matrix or mesh
- if (seenV) {
- #if ABL_PLANAR
- planner.bed_level_matrix.debug(F("Bed Level Correction Matrix:"));
- #else
- if (leveling_is_valid()) {
- #if ENABLED(AUTO_BED_LEVELING_BILINEAR)
- bedlevel.print_leveling_grid();
- #elif ENABLED(MESH_BED_LEVELING)
- SERIAL_ECHOLNPGM("Mesh Bed Level data:");
- bedlevel.report_mesh();
- #endif
- }
- #endif
- }
-
- #if ENABLED(ENABLE_LEVELING_FADE_HEIGHT)
- if (parser.seen('Z')) set_z_fade_height(parser.value_linear_units(), false);
- #endif
-
- // Enable leveling if specified, or if previously active
- set_bed_leveling_enabled(to_enable);
-
- #if HAS_MESH
- EXIT_M420:
- #endif
-
- // Error if leveling failed to enable or reenable
- if (to_enable && !planner.leveling_active)
- SERIAL_ERROR_MSG(STR_ERR_M420_FAILED);
-
- SERIAL_ECHO_START();
- SERIAL_ECHOPGM("Bed Leveling ");
- serialprintln_onoff(planner.leveling_active);
-
- #if ENABLED(ENABLE_LEVELING_FADE_HEIGHT)
- SERIAL_ECHO_START();
- SERIAL_ECHOPGM("Fade Height ");
- if (planner.z_fade_height > 0.0)
- SERIAL_ECHOLN(planner.z_fade_height);
- else
- SERIAL_ECHOLNPGM(STR_OFF);
- #endif
-
- // Report change in position
- if (oldpos != current_position)
- report_current_position();
- }
-
- void GcodeSuite::M420_report(const bool forReplay/*=true*/) {
- report_heading_etc(forReplay, F(
- TERN(MESH_BED_LEVELING, "Mesh Bed Leveling", TERN(AUTO_BED_LEVELING_UBL, "Unified Bed Leveling", "Auto Bed Leveling"))
- ));
- SERIAL_ECHOF(
- F(" M420 S"), planner.leveling_active
- #if ENABLED(ENABLE_LEVELING_FADE_HEIGHT)
- , FPSTR(SP_Z_STR), LINEAR_UNIT(planner.z_fade_height)
- #endif
- , F(" ; Leveling ")
- );
- serialprintln_onoff(planner.leveling_active);
- }
-
- #endif // HAS_LEVELING
|