endstop_phase: Fix endstop_phase on trinamic drivers that aren't inverted

Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
This commit is contained in:
Kevin O'Connor
2019-06-06 18:14:45 -04:00
committed by KevinOConnor
parent 0b02d7a1f2
commit 80194a7e18
4 changed files with 6 additions and 1 deletions

View File

@@ -227,7 +227,7 @@ class TMCMicrostepHelper:
field_name = "MSTEP"
reg = self.mcu_tmc.get_register(self.fields.lookup_register(field_name))
mscnt = self.fields.get_field(field_name, reg)
return mscnt >> self.fields.get_field("MRES")
return (1023 - mscnt) >> self.fields.get_field("MRES")
# Helper to configure "stealthchop" mode
def TMCStealthchopHelper(config, mcu_tmc, tmc_freq):