gcode: Minor code change to M206 to make the math similar to SET_GCODE_OFFSET

Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
This commit is contained in:
Kevin O'Connor 2019-05-26 12:37:14 -04:00
parent d6b69938ab
commit 423bbada84
1 changed files with 5 additions and 4 deletions

View File

@ -626,11 +626,12 @@ class GCodeParser:
raise error(str(e)) raise error(str(e))
def cmd_M206(self, params): def cmd_M206(self, params):
# Offset axes # Offset axes
offsets = { self.axis2pos[a]: self.get_float(a, params) offsets = { self.axis2pos[a]: -self.get_float(a, params)
for a in 'XYZ' if a in params } for a in 'XYZ' if a in params }
for p, offset in offsets.items(): for pos, offset in offsets.items():
self.base_position[p] -= self.homing_position[p] + offset delta = offset - self.homing_position[pos]
self.homing_position[p] = -offset self.base_position[pos] += delta
self.homing_position[pos] = offset
# G-Code temperature and fan commands # G-Code temperature and fan commands
cmd_M105_when_not_ready = True cmd_M105_when_not_ready = True
def cmd_M105(self, params): def cmd_M105(self, params):