mirror of
https://github.com/Klipper3d/klipper.git
synced 2025-07-15 18:58:03 -06:00
z_tilt: Add support for Z_TILT_ADJUST
Add new module to support independent adjustments to multiple Z steppers to account for bed tilt. Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
This commit is contained in:
parent
4bf1b042b1
commit
3025638b9b
5 changed files with 152 additions and 2 deletions
|
@ -23,6 +23,7 @@ class MCU_stepper:
|
|||
self._min_stop_interval = 0.
|
||||
self._reset_cmd_id = self._get_position_cmd = None
|
||||
self._ffi_lib = self._stepqueue = None
|
||||
self._stepcompress_push_const = self._stepcompress_push_delta = None
|
||||
def get_mcu(self):
|
||||
return self._mcu
|
||||
def setup_dir_pin(self, pin_params):
|
||||
|
@ -60,6 +61,7 @@ class MCU_stepper:
|
|||
self._invert_dir, self._oid),
|
||||
self._ffi_lib.stepcompress_free)
|
||||
self._mcu.register_stepqueue(self._stepqueue)
|
||||
self.set_ignore_move(False)
|
||||
def get_oid(self):
|
||||
return self._oid
|
||||
def get_step_dist(self):
|
||||
|
@ -75,6 +77,13 @@ class MCU_stepper:
|
|||
if mcu_pos >= 0.:
|
||||
return int(mcu_pos + 0.5)
|
||||
return int(mcu_pos - 0.5)
|
||||
def set_ignore_move(self, ignore_move):
|
||||
if ignore_move:
|
||||
self._stepcompress_push_const = (lambda *args: 0)
|
||||
self._stepcompress_push_delta = (lambda *args: 0)
|
||||
else:
|
||||
self._stepcompress_push_const = self._ffi_lib.stepcompress_push_const
|
||||
self._stepcompress_push_delta = self._ffi_lib.stepcompress_push_delta
|
||||
def note_homing_start(self, homing_clock):
|
||||
ret = self._ffi_lib.stepcompress_set_homing(
|
||||
self._stepqueue, homing_clock)
|
||||
|
@ -109,7 +118,7 @@ class MCU_stepper:
|
|||
def step_const(self, print_time, start_pos, dist, start_v, accel):
|
||||
inv_step_dist = self._inv_step_dist
|
||||
step_offset = self._commanded_pos - start_pos * inv_step_dist
|
||||
count = self._ffi_lib.stepcompress_push_const(
|
||||
count = self._stepcompress_push_const(
|
||||
self._stepqueue, print_time, step_offset, dist * inv_step_dist,
|
||||
start_v * inv_step_dist, accel * inv_step_dist)
|
||||
if count == STEPCOMPRESS_ERROR_RET:
|
||||
|
@ -119,7 +128,7 @@ class MCU_stepper:
|
|||
, height_base, startxy_d, arm_d, movez_r):
|
||||
inv_step_dist = self._inv_step_dist
|
||||
height = self._commanded_pos - height_base * inv_step_dist
|
||||
count = self._ffi_lib.stepcompress_push_delta(
|
||||
count = self._stepcompress_push_delta(
|
||||
self._stepqueue, print_time, dist * inv_step_dist,
|
||||
start_v * inv_step_dist, accel * inv_step_dist,
|
||||
height, startxy_d * inv_step_dist, arm_d * inv_step_dist, movez_r)
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue