77 lines
2.9 KiB
Python
77 lines
2.9 KiB
Python
# Code for state tracking during homing operations
|
|
#
|
|
# Copyright (C) 2016,2017 Kevin O'Connor <kevin@koconnor.net>
|
|
#
|
|
# This file may be distributed under the terms of the GNU GPLv3 license.
|
|
import logging
|
|
|
|
HOMING_DELAY = 0.250
|
|
|
|
class Homing:
|
|
def __init__(self, toolhead, changed_axes):
|
|
self.toolhead = toolhead
|
|
self.changed_axes = changed_axes
|
|
self.verify_retract = True
|
|
def set_no_verify_retract(self):
|
|
self.verify_retract = False
|
|
def set_axes(self, axes):
|
|
self.changed_axes = axes
|
|
def get_axes(self):
|
|
return self.changed_axes
|
|
def _fill_coord(self, coord):
|
|
# Fill in any None entries in 'coord' with current toolhead position
|
|
thcoord = list(self.toolhead.get_position())
|
|
for i in range(len(coord)):
|
|
if coord[i] is not None:
|
|
thcoord[i] = coord[i]
|
|
return thcoord
|
|
def retract(self, newpos, speed):
|
|
self.toolhead.move(self._fill_coord(newpos), speed)
|
|
def home(self, forcepos, movepos, steppers, speed, second_home=False):
|
|
# Alter kinematics class to think printer is at forcepos
|
|
self.toolhead.set_position(self._fill_coord(forcepos))
|
|
# Start homing and issue move
|
|
if not second_home:
|
|
self.toolhead.dwell(HOMING_DELAY)
|
|
print_time = self.toolhead.get_last_move_time()
|
|
endstops = []
|
|
for s in steppers:
|
|
s.mcu_endstop.home_start(print_time, s.step_dist / speed)
|
|
endstops.append((s, s.mcu_stepper.get_mcu_position()))
|
|
self.toolhead.move(self._fill_coord(movepos), speed)
|
|
move_end_print_time = self.toolhead.get_last_move_time()
|
|
self.toolhead.reset_print_time()
|
|
for s, last_pos in endstops:
|
|
s.mcu_endstop.home_finalize(move_end_print_time)
|
|
# Wait for endstops to trigger
|
|
for s, last_pos in endstops:
|
|
try:
|
|
s.mcu_endstop.home_wait()
|
|
except s.mcu_endstop.error as e:
|
|
raise EndstopError("Failed to home stepper %s: %s" % (
|
|
s.name, str(e)))
|
|
post_home_pos = s.mcu_stepper.get_mcu_position()
|
|
if second_home and self.verify_retract and last_pos == post_home_pos:
|
|
raise EndstopError("Endstop %s still triggered after retract" % (
|
|
s.name,))
|
|
def set_homed_position(self, pos):
|
|
self.toolhead.set_position(self._fill_coord(pos))
|
|
|
|
def query_endstops(print_time, steppers):
|
|
for s in steppers:
|
|
s.mcu_endstop.query_endstop(print_time)
|
|
out = []
|
|
for s in steppers:
|
|
try:
|
|
out.append((s.name, s.mcu_endstop.query_endstop_wait()))
|
|
except s.mcu_endstop.error as e:
|
|
raise EndstopError(str(e))
|
|
return out
|
|
|
|
class EndstopError(Exception):
|
|
pass
|
|
|
|
def EndstopMoveError(pos, msg="Move out of range"):
|
|
return EndstopError("%s: %.3f %.3f %.3f [%.3f]" % (
|
|
msg, pos[0], pos[1], pos[2], pos[3]))
|