mangavalkandClaude Opus 5.5
25891640b8
bdpressure.py leaves the extruder at the last PA_CALIBRATE test value (0.098) when it finds no result, and _PA_AFTER_CALIBRATE saved that as the calibrated PA (lane1 after an AFC pause, lane5 after the sensor went silent). A run is now rejected, with nothing cached or written to Spoolman, when the PA is still at the end of the scan, the printer paused during the test, or bd_pressure gave too few or too few different readings. The previous valid PA (or fallback_pa) is applied instead. bdpressure_check reports pa_points and pa_distinct from the bdpressure module's last PA_CALIBRATE data for this. Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
123 lines
5.0 KiB
Python
123 lines
5.0 KiB
Python
# Load check using the bd_pressure firmware extension (bdp_check_ext.patch).
|
|
#
|
|
# Uses the I2C connection the existing [bdpressure <name>] section already
|
|
# set up. Before writing anything it reads the extension marker (bytes
|
|
# 54-55 = 0xBD 0x01). On stock firmware the marker is missing and every
|
|
# command only reports "not available": nothing is written, because
|
|
# writing past the stock register table would land in the sensor's RAM.
|
|
#
|
|
# Install: copy to ~/klipper/klippy/extras/bdpressure_check.py
|
|
#
|
|
# Config:
|
|
# [bdpressure_check]
|
|
# sensor: bd_pa # name after "bdpressure" in [bdpressure bd_pa]
|
|
#
|
|
# Commands (run them after M400, they act immediately, not in the move queue):
|
|
# BDP_CHECK_START freeze the baseline and start measuring
|
|
# BDP_CHECK_STOP stop measuring and read the result
|
|
# BDP_CHECK_QUERY read the current values without stopping
|
|
#
|
|
# Status (printer.bdpressure_check), updated by the commands above:
|
|
# available, running, peak, above_ms, longest_ms, delta
|
|
# pa_points, pa_distinct - readings the [bdpressure] module collected in
|
|
# its last PA_CALIBRATE, and how many of them differ (read
|
|
# from that module, not from the sensor). A sensor that
|
|
# stops answering gives few points; one that hangs repeats
|
|
# the same reading. LANE_CALIBRATE_PA rejects such runs.
|
|
|
|
REG_EXT = 54 # first byte of the extension
|
|
REG_CTRL = 56
|
|
EXT_LEN = 12 # bytes 54-65
|
|
EXT_MAGIC = (0xBD, 0x01)
|
|
|
|
|
|
class BDPressureCheck:
|
|
def __init__(self, config):
|
|
self.printer = config.get_printer()
|
|
self.sensor_name = 'bdpressure ' + config.get('sensor', 'bd_pa')
|
|
self.i2c = None
|
|
self.sensor = None
|
|
self.status = {'available': False, 'running': False, 'peak': 0,
|
|
'above_ms': 0, 'longest_ms': 0, 'delta': 0}
|
|
self.printer.register_event_handler('klippy:connect',
|
|
self._handle_connect)
|
|
gcode = self.printer.lookup_object('gcode')
|
|
gcode.register_command('BDP_CHECK_START', self.cmd_START,
|
|
desc="Start a bd_pressure load check")
|
|
gcode.register_command('BDP_CHECK_STOP', self.cmd_STOP,
|
|
desc="Stop the bd_pressure load check and read it")
|
|
gcode.register_command('BDP_CHECK_QUERY', self.cmd_QUERY,
|
|
desc="Read the bd_pressure load check values")
|
|
|
|
def _handle_connect(self):
|
|
sensor = self.printer.lookup_object(self.sensor_name)
|
|
self.sensor = sensor
|
|
self.i2c = getattr(sensor, 'i2c', None)
|
|
|
|
def _read(self):
|
|
if self.i2c is None:
|
|
self.status['available'] = False
|
|
return False
|
|
data = bytearray(self.i2c.i2c_read([REG_EXT], EXT_LEN)['response'])
|
|
if len(data) < EXT_LEN or tuple(data[0:2]) != EXT_MAGIC:
|
|
self.status['available'] = False
|
|
return False
|
|
u16 = lambda i: data[i] | (data[i + 1] << 8)
|
|
delta = u16(10)
|
|
self.status.update({
|
|
'available': True,
|
|
'running': bool(data[3] & 1),
|
|
'peak': u16(4),
|
|
'above_ms': u16(6),
|
|
'longest_ms': u16(8),
|
|
'delta': delta - 0x10000 if delta & 0x8000 else delta,
|
|
})
|
|
return True
|
|
|
|
def _respond(self, gcmd, prefix):
|
|
s = self.status
|
|
if not s['available']:
|
|
gcmd.respond_info("%s: bd_pressure check extension not found "
|
|
"(stock firmware?), nothing done" % prefix)
|
|
return
|
|
gcmd.respond_info("%s: running=%d peak=%d above=%d ms longest=%d ms "
|
|
"delta=%d" % (prefix, s['running'], s['peak'],
|
|
s['above_ms'], s['longest_ms'],
|
|
s['delta']))
|
|
|
|
def cmd_START(self, gcmd):
|
|
# The values read here are still the previous check's, so only
|
|
# confirm the start instead of printing them.
|
|
if self._read():
|
|
self.i2c.i2c_write([REG_CTRL, 1])
|
|
self.status.update({'running': True, 'peak': 0, 'above_ms': 0,
|
|
'longest_ms': 0})
|
|
gcmd.respond_info("BDP_CHECK_START: started")
|
|
return
|
|
self._respond(gcmd, "BDP_CHECK_START")
|
|
|
|
def cmd_STOP(self, gcmd):
|
|
if self._read():
|
|
self.i2c.i2c_write([REG_CTRL, 0])
|
|
self._read()
|
|
self._respond(gcmd, "BDP_CHECK_STOP")
|
|
|
|
def cmd_QUERY(self, gcmd):
|
|
self._read()
|
|
self._respond(gcmd, "BDP_CHECK_QUERY")
|
|
|
|
def get_status(self, eventtime):
|
|
status = dict(self.status)
|
|
# [val, res, lk, rk, Hk, Ha] per reading, see bdpressure.py
|
|
try:
|
|
data = list(getattr(self.sensor, 'PA_data', None) or [])
|
|
status['pa_points'] = len(data)
|
|
status['pa_distinct'] = len(set(tuple(d[1:]) for d in data))
|
|
except Exception:
|
|
status['pa_points'] = status['pa_distinct'] = -1
|
|
return status
|
|
|
|
|
|
def load_config(config):
|
|
return BDPressureCheck(config)
|