Fix 3x3 mbl condition

prusa3d · Feb 2, 2024 · bacb0b1 · bacb0b1
1 parent 6682237
commit bacb0b1
Showing 1 changed file with 6 additions and 4 deletions.
diff --git a/Firmware/Marlin_main.cpp b/Firmware/Marlin_main.cpp
@@ -2902,10 +2902,12 @@ static void gcode_G80()
         float x_pos = BED_X(ix);
         float y_pos = BED_Y(iy);
 
-        if ((nMeasPoints == 3) && !isOn3x3Mesh) {
-            mesh_point++;
-            mbl.set_z(ix, iy, NAN);
-            continue; //skip
+        if (nMeasPoints == 3) {
+            if (!isOn3x3Mesh) {
+                mesh_point++;
+                mbl.set_z(ix, iy, NAN);
+                continue; //skip
+            }
         } else if ((x_pos < area_min_x || x_pos > area_max_x || y_pos < area_min_y || y_pos > area_max_y) && (!isOn3x3Mesh || has_z)) {
             mesh_point++;
             continue; //skip