1 from __future__ import absolute_import
4 import os, glob, sys, time, math, re, traceback, threading
7 from serial import Serial
9 from avr_isp import stk500v2
10 from avr_isp import ispBase
11 from avr_isp import intelHex
13 from util import profile
24 key=_winreg.OpenKey(_winreg.HKEY_LOCAL_MACHINE,"HARDWARE\\DEVICEMAP\\SERIALCOMM")
27 baselist+=[_winreg.EnumValue(key,i)[1]]
31 return baselist+glob.glob('/dev/ttyUSB*') + glob.glob('/dev/ttyACM*') +glob.glob("/dev/tty.usb*")+glob.glob("/dev/cu.*")+glob.glob("/dev/rfcomm*")
34 return [250000, 230400, 115200, 57600, 38400, 19200, 9600]
36 class VirtualPrinter():
38 self.readList = ['start\n', 'Marlin: Virtual Marlin!\n', '\x80\n']
41 self.lastTempAt = time.time()
43 self.bedTargetTemp = 1.0
45 def write(self, data):
46 if self.readList == None:
48 #print "Send: %s" % (data.rstrip())
49 if 'M104' in data or 'M109' in data:
51 self.targetTemp = float(data[data.find('S')+1:])
54 if 'M140' in data or 'M190' in data:
56 self.bedTargetTemp = float(data[data.find('S')+1:])
60 self.readList.append("ok T:%.2f /%.2f B:%.2f /%.2f @:64\n" % (self.temp, self.targetTemp, self.bedTemp, self.bedTargetTemp))
62 self.readList.append("ok\n")
65 if self.readList == None:
68 timeDiff = self.lastTempAt - time.time()
69 self.lastTempAt = time.time()
70 if abs(self.temp - self.targetTemp) > 1:
71 self.temp += math.copysign(timeDiff, self.targetTemp - self.temp)
72 if abs(self.bedTemp - self.bedTargetTemp) > 1:
73 self.bedTemp += math.copysign(timeDiff, self.bedTargetTemp - self.bedTemp)
74 while len(self.readList) < 1:
79 if self.readList == None:
82 #print "Recv: %s" % (self.readList[0].rstrip())
83 return self.readList.pop(0)
88 class MachineComPrintCallback(object):
89 def mcLog(self, message):
92 def mcTempUpdate(self, temp, bedTemp):
95 def mcStateChange(self, state):
98 def mcMessage(self, message):
101 def mcProgress(self, lineNr):
104 class MachineCom(object):
106 STATE_DETECT_BAUDRATE = 1
108 STATE_OPERATIONAL = 3
113 STATE_CLOSED_WITH_ERROR = 8
115 def __init__(self, port = None, baudrate = None, callbackObject = None):
117 port = profile.getPreference('serial_port')
119 if profile.getPreference('serial_baud') == 'AUTO':
122 baudrate = int(profile.getPreference('serial_baud'))
123 if callbackObject == None:
124 callbackObject = MachineComPrintCallback()
126 self._callback = callbackObject
127 self._state = self.STATE_NONE
129 self._baudrateDetectList = baudrateList()
130 self._baudrateDetectRetry = 0
133 self._gcodeList = None
135 self._commandQueue = queue.Queue()
136 self._logQueue = queue.Queue(256)
139 programmer = stk500v2.Stk500v2()
140 self._log("Serial port list: %s" % (str(serialList())))
141 for port in serialList():
143 self._log("Connecting to: %s" % (port))
144 programmer.connect(port)
145 self._serial = programmer.leaveISP()
147 except ispBase.IspError as (e):
148 self._log("Error while connecting to %s: %s" % (port, str(e)))
151 self._log("Unexpected error while connecting to serial port: %s %s" % (port, getExceptionString()))
153 elif port == 'VIRTUAL':
154 self._serial = VirtualPrinter()
157 self._log("Connecting to: %s" % (port))
159 self._serial = Serial(port, 115200, timeout=0.1)
161 self._serial = Serial(port, baudrate, timeout=2)
163 self._log("Unexpected error while connecting to serial port: %s %s" % (port, getExceptionString()))
164 self._log("Connected to: %s, starting monitor" % (self._serial))
166 self._changeState(self.STATE_DETECT_BAUDRATE)
168 self._changeState(self.STATE_CONNECTING)
169 self.thread = threading.Thread(target=self._monitor)
170 self.thread.daemon = True
173 def _changeState(self, newState):
174 if self._state == newState:
176 oldState = self.getStateString()
177 self._state = newState
178 self._log('Changing monitoring state from \'%s\' to \'%s\'' % (oldState, self.getStateString()))
179 self._callback.mcStateChange(newState)
184 def getStateString(self):
185 if self._state == self.STATE_NONE:
187 if self._state == self.STATE_DETECT_BAUDRATE:
188 return "Detect baudrate"
189 if self._state == self.STATE_CONNECTING:
191 if self._state == self.STATE_OPERATIONAL:
193 if self._state == self.STATE_PRINTING:
195 if self._state == self.STATE_PAUSED:
197 if self._state == self.STATE_CLOSED:
199 if self._state == self.STATE_ERROR:
200 return "Error: %s" % (self._errorValue)
201 if self._state == self.STATE_CLOSED_WITH_ERROR:
202 return "Error: %s" % (self._errorValue)
203 return "?%d?" % (self._state)
205 def isClosedOrError(self):
206 return self._state == self.STATE_ERROR or self._state == self.STATE_CLOSED_WITH_ERROR or self._state == self.STATE_CLOSED
208 def isOperational(self):
209 return self._state == self.STATE_OPERATIONAL or self._state == self.STATE_PRINTING or self._state == self.STATE_PAUSED
211 def isPrinting(self):
212 return self._state == self.STATE_PRINTING
214 def getPrintPos(self):
215 return self._gcodePos
218 return self._state == self.STATE_PAUSED
223 def getBedTemp(self):
227 self._timeoutTime = time.time() + 5
229 line = self._readline()
233 #No matter the state, if we see an error, goto the error state and store the error for reference.
234 if line.startswith('Error: '):
235 #Oh YEAH, consistency.
236 # Marlin reports an MIN/MAX temp error as "Error: x\n: Extruder switched off. MAXTEMP triggered !\n"
237 # But a bed temp error is reported as "Error: Temperature heated bed switched off. MAXTEMP triggered !!"
238 # So we can have an extra newline in the most common case. Awesome work people.
239 if re.match('Error: [0-9]\n', line):
240 line = line.rstrip() + self._readline()
241 self._errorValue = line
242 self._changeState(self.STATE_ERROR)
244 self._temp = float(re.search("[0-9\.]*", line.split('T:')[1]).group(0))
246 self._bedTemp = float(re.search("[0-9\.]*", line.split('B:')[1]).group(0))
247 self._callback.mcTempUpdate(self._temp, self._bedTemp)
248 elif line.strip() != 'ok':
249 self._callback.mcMessage(line)
251 if self._state == self.STATE_DETECT_BAUDRATE:
252 if line == '' or time.time() > self._timeoutTime:
253 if len(self._baudrateDetectList) < 1:
254 self._log("No more baudrates to test, and no suitable baudrate found.")
256 elif self._baudrateDetectRetry > 0:
257 self._baudrateDetectRetry -= 1
258 self._serial.write('\n')
259 self._sendCommand("M105")
261 baudrate = self._baudrateDetectList.pop(0)
263 self._serial.baudrate = baudrate
264 self._serial.timeout = 0.5
265 self._log("Trying baudrate: %d" % (baudrate))
266 self._baudrateDetectRetry = 5
267 self._timeoutTime = time.time() + 5
268 self._serial.write('\n')
269 self._sendCommand("M105")
271 self._log("Unexpected error while setting baudrate: %d %s" % (baudrate, getExceptionString()))
273 self._serial.timeout = 2
274 self._changeState(self.STATE_OPERATIONAL)
275 elif self._state == self.STATE_CONNECTING:
277 self._sendCommand("M105")
279 self._changeState(self.STATE_OPERATIONAL)
280 if time.time() > self._timeoutTime:
282 elif self._state == self.STATE_OPERATIONAL:
283 #Request the temperature on comm timeout (every 2 seconds) when we are not printing.
285 self._sendCommand("M105")
286 elif self._state == self.STATE_PRINTING:
287 if line == '' and time.time() > self._timeoutTime:
288 self._log("Communication timeout during printing, forcing a line")
291 self._timeoutTime = time.time() + 5
292 if not self._commandQueue.empty():
293 self._sendCommand(self._commandQueue.get())
296 elif "resend" in line.lower() or "rs" in line:
298 self._gcodePos = int(line.replace("N:"," ").replace("N"," ").replace(":"," ").split()[-1])
301 self._gcodePos = int(line.split()[1])
302 self._log("Connection closed, closing down monitor")
304 def _log(self, message):
305 self._callback.mcLog(message)
307 self._logQueue.put(message, False)
309 #If the log queue is full, remove the first message and append the new message again
311 self._logQueue.put(message, False)
314 if self._serial == None:
317 ret = self._serial.readline()
319 self._log("Unexpected error while reading serial port: %s" % (getExceptionString()))
320 self._errorValue = getExceptionString()
324 #self._log("Recv: TIMEOUT")
326 self._log("Recv: %s" % (unicode(ret, 'ascii', 'replace').rstrip()))
329 def close(self, isError = False):
330 if self._serial != None:
333 self._changeState(self.STATE_CLOSED_WITH_ERROR)
335 self._changeState(self.STATE_CLOSED)
341 def _sendCommand(self, cmd):
342 if self._serial == None:
344 self._log('Send: %s' % (cmd))
346 self._serial.write(cmd)
347 self._serial.write('\n')
349 self._log("Unexpected error while writing serial port: %s" % (getExceptionString()))
350 self._errorValue = getExceptionString()
354 if self._gcodePos >= len(self._gcodeList):
355 self._changeState(self.STATE_OPERATIONAL)
357 line = self._gcodeList[self._gcodePos]
358 checksum = reduce(lambda x,y:x^y, map(ord, "N%d%s" % (self._gcodePos, line)))
359 self._sendCommand("N%d%s*%d" % (self._gcodePos, line, checksum))
361 self._callback.mcProgress(self._gcodePos)
363 def sendCommand(self, cmd):
364 cmd = cmd.encode('ascii', 'replace')
365 if self.isPrinting():
366 self._commandQueue.put(cmd)
367 elif self.isOperational():
368 self._sendCommand(cmd)
370 def printGCode(self, gcodeList):
371 if not self.isOperational() or self.isPrinting():
373 self._gcodeList = gcodeList
375 self._changeState(self.STATE_PRINTING)
376 for i in xrange(0, 6):
379 def cancelPrint(self):
380 if self.isOperational():
381 self._changeState(self.STATE_OPERATIONAL)
383 def setPause(self, pause):
384 if not pause and self.isPaused():
385 self._changeState(self.STATE_PRINTING)
386 for i in xrange(0, 6):
388 if pause and self.isPrinting():
389 self._changeState(self.STATE_PAUSED)
391 def getExceptionString():
392 locationInfo = traceback.extract_tb(sys.exc_info()[2])[0]
393 return "%s: '%s' @ %s:%s:%d" % (str(sys.exc_info()[0].__name__), str(sys.exc_info()[1]), os.path.basename(locationInfo[0]), locationInfo[2], locationInfo[1])