reijii/IDM
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

fix axis twist compesation

Browse Source
This commit is contained in:
Sgr A* VMT
2024-06-11 22:47:41 +08:00
parent 104bdd1d50
commit 98e55447b6
1 changed files with 11 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

11
idm.py
View File

@@ -93,6 +93,7 @@ class IDMProbe:
self.trapq = None self.trapq = None
self._last_trapq_move = None self._last_trapq_move = None
self.mod_axis_twist_comp = None self.mod_axis_twist_comp = None
self.raw_axis_twist_comp = None
mainsync = self.printer.lookup_object("mcu")._clocksync mainsync = self.printer.lookup_object("mcu")._clocksync
self._mcu = MCU(config, SecondarySync(self.reactor, mainsync)) self._mcu = MCU(config, SecondarySync(self.reactor, mainsync))
@@ -174,7 +175,15 @@ class IDMProbe:
self.mod_axis_twist_comp = self.printer.lookup_object( self.mod_axis_twist_comp = self.printer.lookup_object(
"axis_twist_compensation", None "axis_twist_compensation", None
) )
if self.mod_axis_twist_comp is not None:
if not hasattr(self.mod_axis_twist_comp, "get_z_compensation_value"):
self.raw_axis_twist_comp = self.mod_axis_twist_comp
def get_z_compensation_value(self, pos):
temp = list(pos)
self.raw_axis_twist_comp._update_z_compensation_value(temp)
return temp[2]-pos[2]
axis_twist_comp = type("class",(object,),{"get_z_compensation_value" : get_z_compensation_value, "raw_axis_twist_comp" : self.raw_axis_twist_comp})
self.mod_axis_twist_comp = axis_twist_comp()
# Ensure streaming mode is stopped # Ensure streaming mode is stopped
self.idm_stream_cmd.send([0]) self.idm_stream_cmd.send([0])