393 lines
15 KiB
Python
393 lines
15 KiB
Python
import gi
|
|
import logging
|
|
import contextlib
|
|
import numpy as np
|
|
|
|
gi.require_version("Gtk", "3.0")
|
|
from gi.repository import Gtk, Pango
|
|
|
|
import matplotlib.pyplot as plt
|
|
from matplotlib import cm
|
|
from matplotlib import rc
|
|
from mpl_toolkits.mplot3d import Axes3D
|
|
from matplotlib.backends.backend_gtk3agg import FigureCanvasGTK3Agg as FigureCanvas
|
|
from matplotlib.ticker import LinearLocator
|
|
|
|
from ks_includes.KlippyGcodes import KlippyGcodes
|
|
from ks_includes.screen_panel import ScreenPanel
|
|
|
|
|
|
def create_panel(*args):
|
|
return BedMeshPanel(*args)
|
|
|
|
|
|
class BedMeshPanel(ScreenPanel):
|
|
|
|
def __init__(self, screen, title, back=True):
|
|
super().__init__(screen, title, back)
|
|
self.profiles = {}
|
|
self.show_create = False
|
|
self.active_mesh = None
|
|
|
|
def initialize(self, panel_name):
|
|
|
|
addprofile = self._gtk.ButtonImage("increase", " " + _("Add profile"), "color1", .66, Gtk.PositionType.LEFT, 1)
|
|
addprofile.connect("clicked", self.show_create_profile)
|
|
addprofile.set_hexpand(True)
|
|
clear = self._gtk.ButtonImage("cancel", " " + _("Clear"), "color2", .66, Gtk.PositionType.LEFT, 1)
|
|
clear.connect("clicked", self._clear_mesh)
|
|
clear.set_hexpand(True)
|
|
top_calibrate = self._gtk.ButtonImage("refresh", " " + _("Calibrate"), "color3", .66, Gtk.PositionType.LEFT, 1)
|
|
top_calibrate.connect("clicked", self._send_calibrate)
|
|
top_calibrate.set_hexpand(True)
|
|
|
|
topbar = Gtk.Box(spacing=5)
|
|
topbar.set_hexpand(True)
|
|
topbar.set_vexpand(False)
|
|
topbar.add(addprofile)
|
|
topbar.add(clear)
|
|
topbar.add(top_calibrate)
|
|
|
|
# Create a grid for all profiles
|
|
self.labels['profiles'] = Gtk.Grid()
|
|
self.labels['profiles'].get_style_context().add_class("frame-item")
|
|
self.labels['profiles'].set_valign(Gtk.Align.CENTER)
|
|
|
|
scroll = self._gtk.ScrolledWindow()
|
|
scroll.add(self.labels['profiles'])
|
|
scroll.set_vexpand(True)
|
|
|
|
# Create a box to contain all of the above
|
|
self.labels['main_box'] = Gtk.Box(orientation=Gtk.Orientation.VERTICAL)
|
|
self.labels['main_box'].set_vexpand(True)
|
|
self.labels['main_box'].pack_start(topbar, False, False, 0)
|
|
self.labels['main_box'].pack_end(scroll, True, True, 0)
|
|
|
|
self.load_meshes()
|
|
|
|
self.content.add(self.labels['main_box'])
|
|
|
|
def activate(self):
|
|
for child in self.content.get_children():
|
|
self.content.remove(child)
|
|
self.content.add(self.labels['main_box'])
|
|
|
|
self.activate_mesh(
|
|
self._screen.printer.get_stat("bed_mesh", "profile_name")
|
|
)
|
|
|
|
def activate_mesh(self, profile):
|
|
if profile == "":
|
|
profile = "default"
|
|
|
|
logging.debug(f"Activating profile: {profile} Current: {self.active_mesh}")
|
|
if profile not in self.profiles:
|
|
self.add_profile(profile)
|
|
|
|
if self.active_mesh is not None and self.active_mesh in self.profiles:
|
|
a = self.profiles[self.active_mesh]
|
|
with contextlib.suppress(KeyError):
|
|
a['button_box'].remove(a['calibrate'])
|
|
a['button_box'].pack_start(a['load'], False, False, 0)
|
|
|
|
logging.info(f"Active {self.active_mesh} changing to {profile}")
|
|
self.active_mesh = profile
|
|
|
|
if self.active_mesh is not None:
|
|
a = self.profiles[profile]
|
|
with contextlib.suppress(KeyError):
|
|
a['button_box'].remove(a['load'])
|
|
with contextlib.suppress(KeyError):
|
|
a['button_box'].remove(a['view'])
|
|
a['button_box'].pack_start(a['calibrate'], False, False, 0)
|
|
if self._printer.get_config_section(f"bed_mesh {profile}"):
|
|
a['button_box'].pack_end(a["view"], False, False, 0)
|
|
self._screen.show_all()
|
|
|
|
def add_profile(self, profile):
|
|
|
|
logging.debug(f"Adding Profile: {profile} Current: {self.active_mesh}")
|
|
name = Gtk.Label()
|
|
name.set_markup(f"<big><b>{profile}</b></big>")
|
|
name.set_hexpand(True)
|
|
name.set_vexpand(False)
|
|
name.set_halign(Gtk.Align.START)
|
|
name.set_line_wrap(True)
|
|
name.set_line_wrap_mode(Pango.WrapMode.WORD_CHAR)
|
|
|
|
buttons = {
|
|
"calibrate": self._gtk.ButtonImage("refresh", _("Calibrate"), "color4"),
|
|
"load": self._gtk.ButtonImage("load", _("Load"), "color2"),
|
|
"save": self._gtk.ButtonImage("complete", _("Save"), "color3"),
|
|
"delete": self._gtk.ButtonImage("cancel", _("Delete"), "color3"),
|
|
"view": self._gtk.ButtonImage("bed-level", _("View Mesh"), "color1"),
|
|
}
|
|
buttons["calibrate"].connect("clicked", self.calibrate_mesh)
|
|
buttons["load"].connect("clicked", self.send_load_mesh, profile)
|
|
buttons["save"].connect("clicked", self.send_save_mesh, profile)
|
|
buttons["delete"].connect("clicked", self.send_remove_mesh, profile)
|
|
buttons["view"].connect("clicked", self.show_mesh, profile)
|
|
|
|
for b in buttons.values():
|
|
b.set_hexpand(False)
|
|
b.set_vexpand(False)
|
|
b.set_halign(Gtk.Align.END)
|
|
|
|
button_box = Gtk.Box(orientation=Gtk.Orientation.HORIZONTAL, spacing=5)
|
|
button_box.add(buttons["calibrate"])
|
|
if profile != "default":
|
|
button_box.add(buttons["save"])
|
|
button_box.add(buttons["delete"])
|
|
if self._printer.get_config_section(f"bed_mesh {profile}"):
|
|
button_box.add(buttons["load"])
|
|
button_box.add(buttons["view"])
|
|
|
|
|
|
box = Gtk.Box(orientation=Gtk.Orientation.HORIZONTAL, spacing=5)
|
|
box.pack_start(name, True, True, 0)
|
|
box.pack_start(button_box, False, False, 0)
|
|
|
|
frame = Gtk.Frame()
|
|
frame.get_style_context().add_class("frame-item")
|
|
frame.add(box)
|
|
|
|
self.profiles[profile] = {
|
|
"button_box": button_box,
|
|
"row": frame,
|
|
"calibrate": buttons["calibrate"],
|
|
"load": buttons["load"],
|
|
"save": buttons["save"],
|
|
"delete": buttons["delete"],
|
|
"view": buttons["view"],
|
|
}
|
|
|
|
pl = list(self.profiles)
|
|
if "default" in pl:
|
|
pl.remove('default')
|
|
profiles = sorted(pl)
|
|
pos = profiles.index(profile) + 1 if profile != "default" else 0
|
|
|
|
self.labels['profiles'].insert_row(pos)
|
|
self.labels['profiles'].attach(self.profiles[profile]['row'], 0, pos, 1, 1)
|
|
self.labels['profiles'].show_all()
|
|
|
|
def back(self):
|
|
if self.show_create is True:
|
|
self.remove_create()
|
|
return True
|
|
return False
|
|
|
|
|
|
def load_meshes(self):
|
|
bm_profiles = self._screen.printer.get_config_section_list("bed_mesh ")
|
|
logging.info(f"Bed profiles: {bm_profiles}")
|
|
for prof in bm_profiles:
|
|
self.add_profile(prof[9:])
|
|
|
|
def process_update(self, action, data):
|
|
if action == "notify_status_update":
|
|
with contextlib.suppress(KeyError):
|
|
self.activate_mesh(data['bed_mesh']['profile_name'])
|
|
|
|
def remove_create(self):
|
|
if self.show_create is False:
|
|
return
|
|
|
|
self._screen.remove_keyboard()
|
|
for child in self.content.get_children():
|
|
self.content.remove(child)
|
|
|
|
self.show_create = False
|
|
self.content.add(self.labels['main_box'])
|
|
self.content.show()
|
|
|
|
def remove_profile(self, profile):
|
|
if profile not in self.profiles:
|
|
return
|
|
|
|
pl = list(self.profiles)
|
|
if "default" in pl:
|
|
pl.remove('default')
|
|
profiles = sorted(pl)
|
|
pos = profiles.index(profile) + 1 if profile != "default" else 0
|
|
self.labels['profiles'].remove_row(pos)
|
|
del self.profiles[profile]
|
|
|
|
def show_create_profile(self, widget):
|
|
|
|
for child in self.content.get_children():
|
|
self.content.remove(child)
|
|
|
|
if "create_profile" not in self.labels:
|
|
pl = self._gtk.Label(_("Profile Name:"))
|
|
pl.set_hexpand(False)
|
|
self.labels['profile_name'] = Gtk.Entry()
|
|
self.labels['profile_name'].set_text('')
|
|
self.labels['profile_name'].set_hexpand(True)
|
|
self.labels['profile_name'].connect("activate", self.create_profile)
|
|
self.labels['profile_name'].connect("focus-in-event", self._show_keyboard)
|
|
self.labels['profile_name'].grab_focus_without_selecting()
|
|
|
|
save = self._gtk.ButtonImage("complete", _("Save"), "color3")
|
|
save.set_hexpand(False)
|
|
save.connect("clicked", self.create_profile)
|
|
|
|
box = Gtk.Box()
|
|
box.pack_start(self.labels['profile_name'], True, True, 5)
|
|
box.pack_start(save, False, False, 5)
|
|
|
|
self.labels['create_profile'] = Gtk.Box(orientation=Gtk.Orientation.VERTICAL, spacing=5)
|
|
self.labels['create_profile'].set_valign(Gtk.Align.CENTER)
|
|
self.labels['create_profile'].set_hexpand(True)
|
|
self.labels['create_profile'].set_vexpand(True)
|
|
self.labels['create_profile'].pack_start(pl, True, True, 5)
|
|
self.labels['create_profile'].pack_start(box, True, True, 5)
|
|
|
|
self.content.add(self.labels['create_profile'])
|
|
self._show_keyboard()
|
|
self.show_create = True
|
|
|
|
def _show_keyboard(self, widget=None, event=None):
|
|
self._screen.show_keyboard(entry=self.labels['profile_name'])
|
|
|
|
def show_mesh(self, widget, profile):
|
|
|
|
bm = self._printer.get_config_section(f"bed_mesh {profile}")
|
|
if bm is False:
|
|
logging.info(f"Unable to load profile: {profile}")
|
|
return
|
|
|
|
if profile == self.active_mesh:
|
|
abm = self._printer.get_stat("bed_mesh")
|
|
if abm is None:
|
|
logging.info(f"Unable to load active mesh: {profile}")
|
|
return
|
|
x_range = [int(abm['mesh_min'][0]), int(abm['mesh_max'][0])]
|
|
y_range = [int(abm['mesh_min'][1]), int(abm['mesh_max'][1])]
|
|
minz_mesh = min(min(abm['mesh_matrix']))
|
|
maxz_mesh = max(max(abm['mesh_matrix']))
|
|
# Do not use a very small zscale, because that could be misleading
|
|
minz_mesh = min(minz_mesh, -0.5)
|
|
maxz_mesh = max(maxz_mesh, 0.5)
|
|
z_range = [minz_mesh, maxz_mesh]
|
|
counts = [len(abm['mesh_matrix'][0]), len(abm['mesh_matrix'])]
|
|
deltas = [(x_range[1] - x_range[0]) / (counts[0] - 1), (y_range[1] - y_range[0]) / (counts[1] - 1)]
|
|
x = [(i * deltas[0]) + x_range[0] for i in range(counts[0])]
|
|
y = [(i * deltas[0]) + y_range[0] for i in range(counts[1])]
|
|
x, y = np.meshgrid(x, y)
|
|
z = np.asarray(abm['mesh_matrix'])
|
|
else:
|
|
x_range = [int(bm['min_x']), int(bm['max_x'])]
|
|
y_range = [int(bm['min_y']), int(bm['max_y'])]
|
|
z_range = [min(min(bm['points'])), max(max(bm['points']))]
|
|
deltas = [(x_range[1] - x_range[0]) / (int(bm['x_count']) - 1),
|
|
(y_range[1] - y_range[0]) / (int(bm['y_count']) - 1)]
|
|
x = [(i * deltas[0]) + x_range[0] for i in range(bm['x_count'])]
|
|
y = [(i * deltas[0]) + y_range[0] for i in range(bm['y_count'])]
|
|
x, y = np.meshgrid(x, y)
|
|
z = np.asarray(bm['points'])
|
|
|
|
rc('axes', edgecolor="#e2e2e2", labelcolor="#e2e2e2")
|
|
rc(('xtick', 'ytick'), color="#e2e2e2")
|
|
fig = plt.figure(facecolor='#12121277')
|
|
ax = Axes3D(fig, azim=245, elev=23)
|
|
ax.set(title=profile, xlabel="X", ylabel="Y", facecolor='none')
|
|
ax.spines['bottom'].set_color("#e2e2e2")
|
|
fig.add_axes(ax)
|
|
surf = ax.plot_surface(x, y, z, cmap=cm.coolwarm, vmin=-0.1, vmax=0.1)
|
|
|
|
chartbox = ax.get_position()
|
|
ax.set_position([chartbox.x0, chartbox.y0 + 0.1, chartbox.width * .92, chartbox.height])
|
|
|
|
ax.set_zlim(z_range[0], z_range[1])
|
|
ax.zaxis.set_major_locator(LinearLocator(5))
|
|
# A StrMethodFormatter is used automatically
|
|
ax.zaxis.set_major_formatter('{x:.02f}')
|
|
fig.colorbar(surf, shrink=0.7, aspect=5, pad=0.25)
|
|
|
|
box = Gtk.Box(orientation=Gtk.Orientation.VERTICAL)
|
|
box.set_hexpand(True)
|
|
box.set_vexpand(True)
|
|
|
|
title = Gtk.Label()
|
|
title.set_markup(f"<b>{profile}</b>")
|
|
title.set_hexpand(True)
|
|
title.set_halign(Gtk.Align.CENTER)
|
|
|
|
canvas_box = Gtk.Box()
|
|
canvas_box.set_hexpand(True)
|
|
canvas_box.set_vexpand(True)
|
|
|
|
box.add(title)
|
|
box.add(canvas_box)
|
|
|
|
buttons = [
|
|
{"name": _("Close"), "response": Gtk.ResponseType.CANCEL}
|
|
]
|
|
self._gtk.Dialog(self._screen, buttons, box, self._close_dialog)
|
|
|
|
alloc = canvas_box.get_allocation()
|
|
canvas = FigureCanvas(fig)
|
|
canvas.set_size_request(alloc.width, self._screen.height / 3 * 2)
|
|
canvas_box.add(canvas)
|
|
canvas_box.show_all()
|
|
# Remove the "matplotlib-canvas" class which forces a white background.
|
|
# https://github.com/matplotlib/matplotlib/commit/3c832377fb4c4b32fcbdbc60fdfedb57296bc8c0
|
|
style_ctx = canvas.get_style_context()
|
|
for css_class in style_ctx.list_classes():
|
|
style_ctx.remove_class(css_class)
|
|
|
|
@staticmethod
|
|
def _close_dialog(widget, response):
|
|
widget.destroy()
|
|
|
|
def create_profile(self, widget):
|
|
name = self.labels['profile_name'].get_text()
|
|
if " " in name:
|
|
name = f'"{name}"'
|
|
|
|
self._screen._ws.klippy.gcode_script(f"BED_MESH_PROFILE SAVE={name}")
|
|
self.remove_create()
|
|
|
|
def calibrate_mesh(self, widget):
|
|
self._screen.show_popup_message(_("Calibrating"), level=1)
|
|
if self._screen.printer.get_stat("toolhead", "homed_axes") != "xyz":
|
|
self._screen._ws.klippy.gcode_script(KlippyGcodes.HOME)
|
|
|
|
self._screen._ws.klippy.gcode_script(
|
|
"BED_MESH_CALIBRATE"
|
|
)
|
|
|
|
# Load zcalibrate to do a manual mesh
|
|
if not (self._printer.config_section_exists("probe") or self._printer.config_section_exists("bltouch")):
|
|
self.menu_item_clicked(widget, "refresh", {"name": "Mesh calibrate", "panel": "zcalibrate"})
|
|
|
|
def _clear_mesh(self, widget):
|
|
self._screen._ws.klippy.gcode_script(
|
|
"BED_MESH_CLEAR"
|
|
)
|
|
|
|
def _send_calibrate(self, widget):
|
|
if self._screen.printer.get_stat("toolhead", "homed_axes") != "xyz":
|
|
self._screen._ws.klippy.gcode_script(KlippyGcodes.HOME)
|
|
|
|
self._screen._ws.klippy.gcode_script(
|
|
"BED_MESH_CALIBRATE"
|
|
)
|
|
|
|
def send_load_mesh(self, widget, profile):
|
|
self._screen._ws.klippy.gcode_script(
|
|
KlippyGcodes.bed_mesh_load(profile)
|
|
)
|
|
|
|
def send_save_mesh(self, widget, profile):
|
|
self._screen._ws.klippy.gcode_script(
|
|
KlippyGcodes.bed_mesh_save(profile)
|
|
)
|
|
|
|
def send_remove_mesh(self, widget, profile):
|
|
self._screen._ws.klippy.gcode_script(
|
|
KlippyGcodes.bed_mesh_remove(profile)
|
|
)
|
|
self.remove_profile(profile)
|