264 lines
11 KiB
Python
264 lines
11 KiB
Python
# BLTouch support
|
|
#
|
|
# Copyright (C) 2018-2020 Kevin O'Connor <kevin@koconnor.net>
|
|
#
|
|
# This file may be distributed under the terms of the GNU GPLv3 license.
|
|
import logging
|
|
import homing
|
|
from . import probe
|
|
|
|
SIGNAL_PERIOD = 0.020
|
|
MIN_CMD_TIME = 5 * SIGNAL_PERIOD
|
|
|
|
TEST_TIME = 5 * 60.
|
|
RETRY_RESET_TIME = 1.
|
|
ENDSTOP_REST_TIME = .001
|
|
ENDSTOP_SAMPLE_TIME = .000015
|
|
ENDSTOP_SAMPLE_COUNT = 4
|
|
|
|
Commands = {
|
|
'pin_down': 0.000650, 'touch_mode': 0.001165,
|
|
'pin_up': 0.001475, 'self_test': 0.001780, 'reset': 0.002190,
|
|
'set_5V_output_mode' : 0.001988, 'set_OD_output_mode' : 0.002091,
|
|
'output_mode_store' : 0.001884,
|
|
}
|
|
|
|
# BLTouch "endstop" wrapper
|
|
class BLTouchEndstopWrapper:
|
|
def __init__(self, config):
|
|
self.printer = config.get_printer()
|
|
self.printer.register_event_handler("klippy:connect",
|
|
self.handle_connect)
|
|
self.position_endstop = config.getfloat('z_offset')
|
|
self.stow_on_each_sample = config.getboolean('stow_on_each_sample',
|
|
True)
|
|
self.probe_touch_mode = config.getboolean('probe_with_touch_mode',
|
|
False)
|
|
# Create a pwm object to handle the control pin
|
|
ppins = self.printer.lookup_object('pins')
|
|
self.mcu_pwm = ppins.setup_pin('pwm', config.get('control_pin'))
|
|
self.mcu_pwm.setup_max_duration(0.)
|
|
self.mcu_pwm.setup_cycle_time(SIGNAL_PERIOD)
|
|
self.next_cmd_time = self.action_end_time = 0.
|
|
# Create an "endstop" object to handle the sensor pin
|
|
pin = config.get('sensor_pin')
|
|
pin_params = ppins.lookup_pin(pin, can_invert=True, can_pullup=True)
|
|
mcu = pin_params['chip']
|
|
mcu.register_config_callback(self._build_config)
|
|
self.mcu_endstop = mcu.setup_pin('endstop', pin_params)
|
|
# output mode
|
|
self.output_mode = config.getchoice('set_output_mode',
|
|
{'5V': '5V', 'OD': 'OD',
|
|
None: None}, None)
|
|
# Setup for sensor test
|
|
self.next_test_time = 0.
|
|
self.pin_up_not_triggered = config.getboolean(
|
|
'pin_up_reports_not_triggered', True)
|
|
self.pin_up_touch_triggered = config.getboolean(
|
|
'pin_up_touch_mode_reports_triggered', True)
|
|
self.start_mcu_pos = []
|
|
# Calculate pin move time
|
|
self.pin_move_time = config.getfloat('pin_move_time', 0.680, above=0.)
|
|
# Wrappers
|
|
self.get_mcu = self.mcu_endstop.get_mcu
|
|
self.add_stepper = self.mcu_endstop.add_stepper
|
|
self.get_steppers = self.mcu_endstop.get_steppers
|
|
self.home_wait = self.mcu_endstop.home_wait
|
|
self.query_endstop = self.mcu_endstop.query_endstop
|
|
# Register BLTOUCH_DEBUG command
|
|
self.gcode = self.printer.lookup_object('gcode')
|
|
self.gcode.register_command("BLTOUCH_DEBUG", self.cmd_BLTOUCH_DEBUG,
|
|
desc=self.cmd_BLTOUCH_DEBUG_help)
|
|
self.gcode.register_command("BLTOUCH_STORE", self.cmd_BLTOUCH_STORE,
|
|
desc=self.cmd_BLTOUCH_STORE_help)
|
|
# multi probes state
|
|
self.multi = 'OFF'
|
|
def _build_config(self):
|
|
kin = self.printer.lookup_object('toolhead').get_kinematics()
|
|
for stepper in kin.get_steppers():
|
|
if stepper.is_active_axis('z'):
|
|
self.add_stepper(stepper)
|
|
def handle_connect(self):
|
|
self.set_output_mode(self.output_mode)
|
|
try:
|
|
self.raise_probe()
|
|
except homing.CommandError as e:
|
|
logging.warning("BLTouch raise probe error: %s", str(e))
|
|
def sync_mcu_print_time(self):
|
|
curtime = self.printer.get_reactor().monotonic()
|
|
est_time = self.mcu_pwm.get_mcu().estimated_print_time(curtime)
|
|
self.next_cmd_time = max(self.next_cmd_time, est_time + MIN_CMD_TIME)
|
|
def sync_print_time(self):
|
|
toolhead = self.printer.lookup_object('toolhead')
|
|
print_time = toolhead.get_last_move_time()
|
|
if self.next_cmd_time > print_time:
|
|
toolhead.dwell(self.next_cmd_time - print_time)
|
|
else:
|
|
self.next_cmd_time = print_time
|
|
def send_cmd(self, cmd, duration=MIN_CMD_TIME):
|
|
# Translate duration to ticks to avoid any secondary mcu clock skew
|
|
mcu = self.mcu_pwm.get_mcu()
|
|
cmd_clock = mcu.print_time_to_clock(self.next_cmd_time)
|
|
pulse = int((duration - MIN_CMD_TIME) / SIGNAL_PERIOD) * SIGNAL_PERIOD
|
|
cmd_clock += mcu.seconds_to_clock(max(MIN_CMD_TIME, pulse))
|
|
end_time = mcu.clock_to_print_time(cmd_clock)
|
|
# Schedule command followed by PWM disable
|
|
self.mcu_pwm.set_pwm(self.next_cmd_time, Commands[cmd] / SIGNAL_PERIOD)
|
|
self.mcu_pwm.set_pwm(end_time, 0.)
|
|
# Update time tracking
|
|
self.action_end_time = self.next_cmd_time + duration
|
|
self.next_cmd_time = max(self.action_end_time, end_time + MIN_CMD_TIME)
|
|
def verify_state(self, triggered):
|
|
# Perform endstop check to verify bltouch reports desired state
|
|
self.mcu_endstop.home_start(self.action_end_time, ENDSTOP_SAMPLE_TIME,
|
|
ENDSTOP_SAMPLE_COUNT, ENDSTOP_REST_TIME,
|
|
triggered=triggered)
|
|
return self.mcu_endstop.home_wait(self.action_end_time + 0.100)
|
|
def raise_probe(self):
|
|
self.sync_mcu_print_time()
|
|
if not self.pin_up_not_triggered:
|
|
# No way to verify raise attempt - just issue commands
|
|
self.send_cmd('reset')
|
|
self.send_cmd('pin_up', duration=self.pin_move_time)
|
|
return
|
|
for retry in range(3):
|
|
self.send_cmd('pin_up', duration=self.pin_move_time)
|
|
success = self.verify_state(False)
|
|
if success:
|
|
# The "probe raised" test completed successfully
|
|
break
|
|
if retry >= 2:
|
|
raise homing.EndstopError("BLTouch failed to raise probe")
|
|
msg = "Failed to verify BLTouch probe is raised; retrying."
|
|
self.gcode.respond_info(msg)
|
|
self.sync_mcu_print_time()
|
|
self.send_cmd('reset', duration=RETRY_RESET_TIME)
|
|
def lower_probe(self):
|
|
self.test_sensor()
|
|
self.sync_print_time()
|
|
self.send_cmd('pin_down', duration=self.pin_move_time)
|
|
if self.probe_touch_mode:
|
|
self.send_cmd('touch_mode')
|
|
def test_sensor(self):
|
|
if not self.pin_up_touch_triggered:
|
|
# Nothing to test
|
|
return
|
|
toolhead = self.printer.lookup_object('toolhead')
|
|
print_time = toolhead.get_last_move_time()
|
|
if print_time < self.next_test_time:
|
|
self.next_test_time = print_time + TEST_TIME
|
|
return
|
|
# Raise the bltouch probe and test if probe is raised
|
|
self.sync_print_time()
|
|
for retry in range(3):
|
|
self.send_cmd('pin_up', duration=self.pin_move_time)
|
|
self.send_cmd('touch_mode')
|
|
success = self.verify_state(True)
|
|
self.sync_print_time()
|
|
if success:
|
|
# The "bltouch connection" test completed successfully
|
|
self.next_test_time = print_time + TEST_TIME
|
|
return
|
|
msg = "BLTouch failed to verify sensor state"
|
|
if retry >= 2:
|
|
raise homing.EndstopError(msg)
|
|
self.gcode.respond_info(msg + '; retrying.')
|
|
self.send_cmd('reset', duration=RETRY_RESET_TIME)
|
|
def multi_probe_begin(self):
|
|
if self.stow_on_each_sample:
|
|
return
|
|
self.multi = 'FIRST'
|
|
def multi_probe_end(self):
|
|
if self.stow_on_each_sample:
|
|
return
|
|
self.raise_probe()
|
|
self.sync_print_time()
|
|
self.multi = 'OFF'
|
|
def probe_prepare(self):
|
|
if self.multi == 'OFF' or self.multi == 'FIRST':
|
|
self.lower_probe()
|
|
if self.multi == 'FIRST':
|
|
self.multi = 'ON'
|
|
self.sync_print_time()
|
|
toolhead = self.printer.lookup_object('toolhead')
|
|
toolhead.flush_step_generation()
|
|
self.start_mcu_pos = [(s, s.get_mcu_position())
|
|
for s in self.mcu_endstop.get_steppers()]
|
|
def probe_finish(self):
|
|
if self.multi == 'OFF':
|
|
self.raise_probe()
|
|
self.sync_print_time()
|
|
# Verify the probe actually deployed during the attempt
|
|
for s, mcu_pos in self.start_mcu_pos:
|
|
if s.get_mcu_position() == mcu_pos:
|
|
raise homing.EndstopError("BLTouch failed to deploy")
|
|
def home_start(self, print_time, sample_time, sample_count, rest_time):
|
|
rest_time = min(rest_time, ENDSTOP_REST_TIME)
|
|
return self.mcu_endstop.home_start(print_time, sample_time,
|
|
sample_count, rest_time)
|
|
def get_position_endstop(self):
|
|
return self.position_endstop
|
|
def set_output_mode(self, mode):
|
|
# If this is inadvertently/purposely issued for a
|
|
# BLTOUCH pre V3.0 and clones:
|
|
# No reaction at all.
|
|
# BLTOUCH V3.0 and V3.1:
|
|
# This will set the mode.
|
|
if mode is None:
|
|
return
|
|
logging.info("BLTouch set output mode: %s", mode)
|
|
self.sync_mcu_print_time()
|
|
if mode == '5V':
|
|
self.send_cmd('set_5V_output_mode')
|
|
if mode == 'OD':
|
|
self.send_cmd('set_OD_output_mode')
|
|
def store_output_mode(self, mode):
|
|
# If this command is inadvertently/purposely issued for a
|
|
# BLTOUCH pre V3.0 and clones:
|
|
# No reaction at all to this sequence apart from a pin-down/pin-up
|
|
# BLTOUCH V3.0:
|
|
# This will set the mode (twice) and sadly, a pin-up is needed at
|
|
# the end, because of the pin-down
|
|
# BLTOUCH V3.1:
|
|
# This will set the mode and store it in the eeprom.
|
|
# The pin-up is not needed but does not hurt
|
|
logging.info("BLTouch store output mode: %s", mode)
|
|
self.sync_print_time()
|
|
self.send_cmd('pin_down')
|
|
if mode == '5V':
|
|
self.send_cmd('set_5V_output_mode')
|
|
else:
|
|
self.send_cmd('set_OD_output_mode')
|
|
self.send_cmd('output_mode_store')
|
|
if mode == '5V':
|
|
self.send_cmd('set_5V_output_mode')
|
|
else:
|
|
self.send_cmd('set_OD_output_mode')
|
|
self.send_cmd('pin_up')
|
|
cmd_BLTOUCH_DEBUG_help = "Send a command to the bltouch for debugging"
|
|
def cmd_BLTOUCH_DEBUG(self, gcmd):
|
|
cmd = gcmd.get('COMMAND', None)
|
|
if cmd is None or cmd not in Commands:
|
|
gcmd.respond_info("BLTouch commands: %s" % (
|
|
", ".join(sorted([c for c in Commands if c is not None]))))
|
|
return
|
|
gcmd.respond_info("Sending BLTOUCH_DEBUG COMMAND=%s" % (cmd,))
|
|
self.sync_print_time()
|
|
self.send_cmd(cmd, duration=self.pin_move_time)
|
|
self.sync_print_time()
|
|
cmd_BLTOUCH_STORE_help = "Store an output mode in the BLTouch EEPROM"
|
|
def cmd_BLTOUCH_STORE(self, gcmd):
|
|
cmd = gcmd.get('MODE', None)
|
|
if cmd is None or cmd not in ['5V', 'OD']:
|
|
gcmd.respond_info("BLTouch output modes: 5V, OD")
|
|
return
|
|
gcmd.respond_info("Storing BLTouch output mode: %s" % (cmd,))
|
|
self.sync_print_time()
|
|
self.store_output_mode(cmd)
|
|
self.sync_print_time()
|
|
|
|
def load_config(config):
|
|
blt = BLTouchEndstopWrapper(config)
|
|
config.get_printer().add_object('probe', probe.PrinterProbe(config, blt))
|
|
return blt
|