screws_tilt_adjust: Add MAX_DEVIATION parameter for bed level invariant.

This is useful when a saved bed mesh is used to ensure that the bed level
has not drifted too far from where it was when the mesh was created.

Signed-off-by: Johannes Stuettgen <johannes.stuettgen@gmail.com>
This commit is contained in:
Johannes Stuettgen
2021-02-08 17:52:46 +01:00
committed by KevinOConnor
parent d36dbfebd1
commit ed6ab6b9cc
3 changed files with 16 additions and 0 deletions

View File

@@ -19,6 +19,7 @@ class ScrewsTiltAdjust:
self.config = config
self.printer = config.get_printer()
self.screws = []
self.max_diff = None
# Read config
for i in range(99):
prefix = "screw%d" % (i + 1,)
@@ -51,11 +52,13 @@ class ScrewsTiltAdjust:
"of turns to level it."
def cmd_SCREWS_TILT_CALCULATE(self, gcmd):
self.max_diff = gcmd.get_float("MAX_DEVIATION", None)
self.probe_helper.start_probe(gcmd)
def probe_finalize(self, offsets, positions):
# Factors used for CW-M3, CCW-M3, CW-M4, CCW-M4, CW-M5 and CCW-M5
threads_factor = {0: 0.5, 1: 0.5, 2: 0.7, 3: 0.7, 4: 0.8, 5: 0.8}
screw_diff = []
# Process the read Z values and
for i, screw in enumerate(self.screws):
if i == 0:
@@ -71,6 +74,7 @@ class ScrewsTiltAdjust:
z = positions[i][2]
coord, name = screw
diff = z_base - z
screw_diff.append(abs(diff))
if abs(diff) < 0.001:
adjust = 0
else:
@@ -87,6 +91,10 @@ class ScrewsTiltAdjust:
"Adjust -> %s %02d:%02d" %
(name, coord[0], coord[1], z, sign,
abs(full_turns), abs(minutes)))
if self.max_diff and any((d > self.max_diff) for d in screw_diff):
raise self.gcode.error(
"bed level exceeds configured limits ({}mm)! " \
"Adjust screws and restart print.".format(self.max_diff))
def load_config(config):
return ScrewsTiltAdjust(config)