# Smoothieboard motion controller plugin from __future__ import absolute_import from __future__ import print_function from _GenericController import _GenericController from _GenericController import POSPAT, TLOPAT, DOLLARPAT from CNC import CNC import time class Controller(_GenericController): def __init__(self, master): self.gcode_case = 1 self.has_override = False self.master = master #print("smoothie loaded") def executeCommand(self, oline, line, cmd): if line[0] in ( "help", "version", "mem", "ls", "cd", "pwd", "cat", "rm", "mv", "remount", "play", "progress", "abort", "reset", "dfu", "break", "config-get", "config-set", "get", "set_temp", "get", "get", "net", "load", "save", "upload", "calc_thermistor", "thermistors", "md5sum", "fire", "switch"): if self.master.serial: self.master.serial_write(oline+"\n") return True return False def hardResetPre(self): self.master.serial_write(b"reset\n") def hardResetAfter(self): time.sleep(6) def viewBuild(self): self.master.serial_write(b"version\n") self.master.sendGCode("$I") def grblHelp(self): self.master.serial_write(b"help\n") def parseBracketAngle(self, line, cline): # ln= line[1:-1] # strip off < .. > # split fields l= ln.split('|') # strip off status CNC.vars["state"]= l[0] # strip of rest into a dict of name: [values,...,] d= { a: [float(y) for y in b.split(',')] for a, b in [x.split(':') for x in l[1:]] } CNC.vars["mx"] = float(d['MPos'][0]) CNC.vars["my"] = float(d['MPos'][1]) CNC.vars["mz"] = float(d['MPos'][2]) CNC.vars["wx"] = float(d['WPos'][0]) CNC.vars["wy"] = float(d['WPos'][1]) CNC.vars["wz"] = float(d['WPos'][2]) CNC.vars["wcox"] = CNC.vars["mx"] - CNC.vars["wx"] CNC.vars["wcoy"] = CNC.vars["my"] - CNC.vars["wy"] CNC.vars["wcoz"] = CNC.vars["mz"] - CNC.vars["wz"] if 'F' in d: CNC.vars["curfeed"] = float(d['F'][0]) self.master._posUpdate = True # Machine is Idle buffer is empty # stop waiting and go on if self.master.sio_wait and not cline and l[0] not in ("Run","Jog", "Hold"): self.master.sio_wait = False self.master._gcount += 1 def parseBracketSquare(self, line): pat = POSPAT.match(line) if pat: if pat.group(1) == "PRB": CNC.vars["prbx"] = float(pat.group(2)) CNC.vars["prby"] = float(pat.group(3)) CNC.vars["prbz"] = float(pat.group(4)) #if self.running: self.master.gcode.probe.add( CNC.vars["prbx"] +CNC.vars["wx"] -CNC.vars["mx"], CNC.vars["prby"] +CNC.vars["wy"] -CNC.vars["my"], CNC.vars["prbz"] +CNC.vars["wz"] -CNC.vars["mz"]) self.master._probeUpdate = True CNC.vars[pat.group(1)] = \ [float(pat.group(2)), float(pat.group(3)), float(pat.group(4))] else: pat = TLOPAT.match(line) if pat: CNC.vars[pat.group(1)] = pat.group(2) self.master._probeUpdate = True elif DOLLARPAT.match(line): CNC.vars["G"] = line[1:-1].split() CNC.updateG() self.master._gUpdate = True