diff options
author | Alex Voinea <voinea.dragos.alexandru@gmail.com> | 2024-05-14 22:21:58 +0200 |
---|---|---|
committer | KevinOConnor <kevin@koconnor.net> | 2024-05-14 18:21:24 -0400 |
commit | 5249d955bb0a4ee131cc3def5d9d53d61e2d4334 (patch) | |
tree | 0360209248e6c5a0e8b1cb83e529bf6c859188e2 /klippy/extras | |
parent | 0f3f29101ca49e913354811430d43776f13bcdbb (diff) | |
download | kutter-5249d955bb0a4ee131cc3def5d9d53d61e2d4334.tar.gz kutter-5249d955bb0a4ee131cc3def5d9d53d61e2d4334.tar.xz kutter-5249d955bb0a4ee131cc3def5d9d53d61e2d4334.zip |
tmc: Implement coolstep_threshold for drivers that support it
Signed-off-by: Alex Voinea <voinea.dragos.alexandru@gmail.com>
Diffstat (limited to 'klippy/extras')
-rw-r--r-- | klippy/extras/tmc.py | 16 | ||||
-rw-r--r-- | klippy/extras/tmc2130.py | 1 | ||||
-rw-r--r-- | klippy/extras/tmc2209.py | 1 | ||||
-rw-r--r-- | klippy/extras/tmc2240.py | 2 | ||||
-rw-r--r-- | klippy/extras/tmc5160.py | 2 |
5 files changed, 22 insertions, 0 deletions
diff --git a/klippy/extras/tmc.py b/klippy/extras/tmc.py index 4ce9466a..e7c0239f 100644 --- a/klippy/extras/tmc.py +++ b/klippy/extras/tmc.py @@ -616,3 +616,19 @@ def TMCStealthchopHelper(config, mcu_tmc): else: # TMC2208 uses en_spreadCycle fields.set_field("en_spreadcycle", not en_pwm_mode) + +# Helper to configure StallGuard and CoolStep minimum velocity +def TMCVcoolthrsHelper(config, mcu_tmc): + fields = mcu_tmc.get_fields() + velocity = config.getfloat('coolstep_threshold', None, minval=0.) + tcoolthrs = 0 + + if velocity is not None: + stepper_name = " ".join(config.get_name().split()[1:]) + sconfig = config.getsection(stepper_name) + rotation_dist, steps_per_rotation = stepper.parse_step_distance(sconfig) + step_dist = rotation_dist / steps_per_rotation + mres = fields.get_field("mres") + tcoolthrs = TMCtstepHelper(step_dist, mres, + mcu_tmc.get_tmc_frequency(), velocity) + fields.set_field("tcoolthrs", tcoolthrs) diff --git a/klippy/extras/tmc2130.py b/klippy/extras/tmc2130.py index f995fb7a..44d4342b 100644 --- a/klippy/extras/tmc2130.py +++ b/klippy/extras/tmc2130.py @@ -297,6 +297,7 @@ class TMC2130: # Setup basic register values tmc.TMCWaveTableHelper(config, self.mcu_tmc) tmc.TMCStealthchopHelper(config, self.mcu_tmc) + tmc.TMCVcoolthrsHelper(config, self.mcu_tmc) # Allow other registers to be set from the config set_config_field = self.fields.set_config_field # CHOPCONF diff --git a/klippy/extras/tmc2209.py b/klippy/extras/tmc2209.py index ac997a81..fbd8d1c1 100644 --- a/klippy/extras/tmc2209.py +++ b/klippy/extras/tmc2209.py @@ -74,6 +74,7 @@ class TMC2209: # Setup basic register values self.fields.set_field("mstep_reg_select", True) tmc.TMCStealthchopHelper(config, self.mcu_tmc) + tmc.TMCVcoolthrsHelper(config, self.mcu_tmc) # Allow other registers to be set from the config set_config_field = self.fields.set_config_field # GCONF diff --git a/klippy/extras/tmc2240.py b/klippy/extras/tmc2240.py index f4c75aa9..3989b902 100644 --- a/klippy/extras/tmc2240.py +++ b/klippy/extras/tmc2240.py @@ -365,6 +365,8 @@ class TMC2240: tmc.TMCWaveTableHelper(config, self.mcu_tmc) self.fields.set_config_field(config, "offset_sin90", 0) tmc.TMCStealthchopHelper(config, self.mcu_tmc) + tmc.TMCVcoolthrsHelper(config, self.mcu_tmc) + # Allow other registers to be set from the config set_config_field = self.fields.set_config_field # GCONF set_config_field(config, "multistep_filt", True) diff --git a/klippy/extras/tmc5160.py b/klippy/extras/tmc5160.py index e37435e6..97d2d6f9 100644 --- a/klippy/extras/tmc5160.py +++ b/klippy/extras/tmc5160.py @@ -336,6 +336,8 @@ class TMC5160: # Setup basic register values tmc.TMCWaveTableHelper(config, self.mcu_tmc) tmc.TMCStealthchopHelper(config, self.mcu_tmc) + tmc.TMCVcoolthrsHelper(config, self.mcu_tmc) + # Allow other registers to be set from the config set_config_field = self.fields.set_config_field # GCONF set_config_field(config, "multistep_filt", True) |