2012-03-22 14:30:28 +00:00
|
|
|
from __future__ import absolute_import
|
|
|
|
import __init__
|
|
|
|
|
2012-02-28 14:02:24 +00:00
|
|
|
import sys
|
|
|
|
import math
|
|
|
|
import re
|
2012-03-18 12:00:31 +00:00
|
|
|
import os
|
2012-02-28 14:02:24 +00:00
|
|
|
|
2012-03-28 12:26:40 +00:00
|
|
|
from util import util3d
|
2012-04-03 10:06:02 +00:00
|
|
|
from util import profile
|
2012-02-28 14:02:24 +00:00
|
|
|
|
2012-03-26 15:14:31 +00:00
|
|
|
class gcodePath():
|
2012-03-29 09:01:33 +00:00
|
|
|
def __init__(self, newType, pathType, startPoint):
|
2012-03-26 15:14:31 +00:00
|
|
|
self.type = newType
|
|
|
|
self.pathType = pathType
|
|
|
|
self.list = [startPoint]
|
|
|
|
|
2012-02-28 14:02:24 +00:00
|
|
|
class gcode():
|
2012-03-22 15:04:53 +00:00
|
|
|
def __init__(self):
|
2012-03-22 14:30:28 +00:00
|
|
|
self.regMatch = {}
|
2012-03-29 09:01:33 +00:00
|
|
|
self.layerList = []
|
2012-03-22 15:04:53 +00:00
|
|
|
self.extrusionAmount = 0
|
|
|
|
self.totalMoveTimeMinute = 0
|
|
|
|
self.progressCallback = None
|
2012-03-22 14:30:28 +00:00
|
|
|
|
2012-03-22 15:04:53 +00:00
|
|
|
def load(self, filename):
|
2012-04-02 16:56:44 +00:00
|
|
|
self._fileSize = os.stat(filename).st_size
|
2012-03-22 14:12:37 +00:00
|
|
|
gcodeFile = open(filename, 'r')
|
2012-04-02 16:56:44 +00:00
|
|
|
self._load(gcodeFile)
|
|
|
|
gcodeFile.close()
|
|
|
|
|
|
|
|
def loadList(self, l):
|
|
|
|
self._load(l)
|
|
|
|
|
2012-04-03 10:06:02 +00:00
|
|
|
def calculateWeight(self):
|
|
|
|
#Calculates the weight of the filament in kg
|
|
|
|
radius = float(profile.getProfileSetting('filament_diameter')) / 2
|
|
|
|
volumeM3 = (self.extrusionAmount * (math.pi * radius * radius)) / (1000*1000*1000)
|
|
|
|
return volumeM3 * float(profile.getPreference('filament_density'))
|
|
|
|
|
2012-04-02 16:56:44 +00:00
|
|
|
def _load(self, gcodeFile):
|
|
|
|
filePos = 0
|
2012-03-15 16:14:20 +00:00
|
|
|
pos = util3d.Vector3()
|
|
|
|
posOffset = util3d.Vector3()
|
2012-03-16 12:27:04 +00:00
|
|
|
currentE = 0.0
|
|
|
|
totalExtrusion = 0.0
|
2012-03-16 12:43:49 +00:00
|
|
|
maxExtrusion = 0.0
|
2012-03-16 14:41:39 +00:00
|
|
|
totalMoveTimeMinute = 0.0
|
2012-02-28 14:02:24 +00:00
|
|
|
scale = 1.0
|
|
|
|
posAbs = True
|
2012-02-28 16:39:46 +00:00
|
|
|
feedRate = 3600
|
2012-02-28 14:02:24 +00:00
|
|
|
pathType = 'CUSTOM';
|
2012-02-28 16:39:46 +00:00
|
|
|
startCodeDone = False
|
2012-03-29 09:01:33 +00:00
|
|
|
currentLayer = []
|
|
|
|
currentPath = gcodePath('move', pathType, pos.copy())
|
2012-03-26 15:14:31 +00:00
|
|
|
currentPath.list[0].e = totalExtrusion
|
2012-03-29 09:01:33 +00:00
|
|
|
currentLayer.append(currentPath)
|
2012-03-22 14:12:37 +00:00
|
|
|
for line in gcodeFile:
|
2012-04-02 16:56:44 +00:00
|
|
|
if self.progressCallback != None:
|
|
|
|
if filePos != gcodeFile.tell():
|
|
|
|
filePos = gcodeFile.tell()
|
|
|
|
self.progressCallback(float(filePos) / float(self._fileSize))
|
2012-03-29 09:01:33 +00:00
|
|
|
|
|
|
|
#Parse Cura_SF comments
|
2012-02-28 14:02:24 +00:00
|
|
|
if line.startswith(';TYPE:'):
|
|
|
|
pathType = line[6:].strip()
|
2012-02-28 16:39:46 +00:00
|
|
|
if pathType != "CUSTOM":
|
|
|
|
startCodeDone = True
|
2012-03-27 11:48:40 +00:00
|
|
|
|
2012-03-26 13:03:26 +00:00
|
|
|
if ';' in line:
|
2012-03-27 11:48:40 +00:00
|
|
|
#Slic3r GCode comment parser
|
2012-03-26 13:03:26 +00:00
|
|
|
comment = line[line.find(';')+1:].strip()
|
|
|
|
if comment == 'fill':
|
|
|
|
pathType = 'FILL'
|
|
|
|
elif comment == 'perimeter':
|
|
|
|
pathType = 'WALL-INNER'
|
|
|
|
elif comment == 'skirt':
|
|
|
|
pathType = 'SKIRT'
|
|
|
|
if pathType != "CUSTOM":
|
|
|
|
startCodeDone = True
|
|
|
|
line = line[0:line.find(';')]
|
2012-03-27 11:48:40 +00:00
|
|
|
|
2012-02-28 14:02:24 +00:00
|
|
|
G = self.getCodeInt(line, 'G')
|
|
|
|
if G is not None:
|
|
|
|
if G == 0 or G == 1: #Move
|
|
|
|
x = self.getCodeFloat(line, 'X')
|
|
|
|
y = self.getCodeFloat(line, 'Y')
|
|
|
|
z = self.getCodeFloat(line, 'Z')
|
|
|
|
e = self.getCodeFloat(line, 'E')
|
2012-02-28 16:39:46 +00:00
|
|
|
f = self.getCodeFloat(line, 'F')
|
2012-03-16 14:41:39 +00:00
|
|
|
oldPos = pos.copy()
|
2012-02-28 14:02:24 +00:00
|
|
|
if x is not None:
|
|
|
|
if posAbs:
|
|
|
|
pos.x = x * scale
|
|
|
|
else:
|
|
|
|
pos.x += x * scale
|
|
|
|
if y is not None:
|
|
|
|
if posAbs:
|
|
|
|
pos.y = y * scale
|
|
|
|
else:
|
|
|
|
pos.y += y * scale
|
|
|
|
if z is not None:
|
|
|
|
if posAbs:
|
|
|
|
pos.z = z * scale
|
|
|
|
else:
|
|
|
|
pos.z += z * scale
|
2012-03-29 09:01:33 +00:00
|
|
|
#Check if we have a new layer.
|
2012-03-16 14:41:39 +00:00
|
|
|
if oldPos.z != pos.z and startCodeDone:
|
2012-03-29 09:01:33 +00:00
|
|
|
self.layerList.append(currentLayer)
|
|
|
|
currentLayer = []
|
2012-02-28 16:39:46 +00:00
|
|
|
if f is not None:
|
|
|
|
feedRate = f
|
2012-03-16 14:41:39 +00:00
|
|
|
if x is not None or y is not None or z is not None:
|
|
|
|
totalMoveTimeMinute += (oldPos - pos).vsize() / feedRate
|
2012-02-28 14:02:24 +00:00
|
|
|
moveType = 'move'
|
|
|
|
if e is not None:
|
2012-03-16 12:27:04 +00:00
|
|
|
if posAbs:
|
|
|
|
if e > currentE:
|
|
|
|
moveType = 'extrude'
|
|
|
|
if e < currentE:
|
|
|
|
moveType = 'retract'
|
|
|
|
totalExtrusion += e - currentE
|
|
|
|
currentE = e
|
|
|
|
else:
|
|
|
|
if e > 0:
|
|
|
|
moveType = 'extrude'
|
|
|
|
if e < 0:
|
|
|
|
moveType = 'retract'
|
|
|
|
totalExtrusion += e
|
|
|
|
currentE += e
|
2012-03-16 12:43:49 +00:00
|
|
|
if totalExtrusion > maxExtrusion:
|
|
|
|
maxExtrusion = totalExtrusion
|
2012-03-26 15:14:31 +00:00
|
|
|
if currentPath.type != moveType or currentPath.pathType != pathType:
|
2012-03-29 09:01:33 +00:00
|
|
|
currentPath = gcodePath(moveType, pathType, currentPath.list[-1])
|
|
|
|
currentLayer.append(currentPath)
|
2012-03-26 15:14:31 +00:00
|
|
|
newPos = pos.copy()
|
|
|
|
newPos.e = totalExtrusion
|
|
|
|
currentPath.list.append(newPos)
|
2012-02-28 14:02:24 +00:00
|
|
|
elif G == 20: #Units are inches
|
|
|
|
scale = 25.4
|
|
|
|
elif G == 21: #Units are mm
|
|
|
|
scale = 1.0
|
|
|
|
elif G == 28: #Home
|
|
|
|
x = self.getCodeFloat(line, 'X')
|
|
|
|
y = self.getCodeFloat(line, 'Y')
|
|
|
|
z = self.getCodeFloat(line, 'Z')
|
|
|
|
if x is None and y is None and z is None:
|
2012-03-15 16:14:20 +00:00
|
|
|
pos = util3d.Vector3()
|
2012-02-28 14:02:24 +00:00
|
|
|
else:
|
|
|
|
if x is not None:
|
|
|
|
pos.x = 0.0
|
|
|
|
if y is not None:
|
|
|
|
pos.y = 0.0
|
|
|
|
if z is not None:
|
|
|
|
pos.z = 0.0
|
|
|
|
elif G == 90: #Absolute position
|
|
|
|
posAbs = True
|
|
|
|
elif G == 91: #Relative position
|
|
|
|
posAbs = False
|
|
|
|
elif G == 92:
|
|
|
|
x = self.getCodeFloat(line, 'X')
|
|
|
|
y = self.getCodeFloat(line, 'Y')
|
|
|
|
z = self.getCodeFloat(line, 'Z')
|
|
|
|
e = self.getCodeFloat(line, 'E')
|
|
|
|
if e is not None:
|
|
|
|
currentE = e
|
|
|
|
if x is not None:
|
|
|
|
posOffset.x = pos.x + x
|
|
|
|
if y is not None:
|
|
|
|
posOffset.y = pos.y + y
|
|
|
|
if z is not None:
|
|
|
|
posOffset.z = pos.z + z
|
|
|
|
else:
|
|
|
|
print "Unknown G code:" + str(G)
|
|
|
|
else:
|
|
|
|
M = self.getCodeInt(line, 'M')
|
|
|
|
if M is not None:
|
|
|
|
if M == 1: #Message with possible wait (ignored)
|
|
|
|
pass
|
|
|
|
elif M == 84: #Disable step drivers
|
|
|
|
pass
|
|
|
|
elif M == 92: #Set steps per unit
|
|
|
|
pass
|
|
|
|
elif M == 104: #Set temperature, no wait
|
|
|
|
pass
|
|
|
|
elif M == 105: #Get temperature
|
|
|
|
pass
|
|
|
|
elif M == 106: #Enable fan
|
|
|
|
pass
|
|
|
|
elif M == 107: #Disable fan
|
|
|
|
pass
|
|
|
|
elif M == 108: #Extruder RPM (these should not be in the final GCode, but they are)
|
|
|
|
pass
|
2012-03-21 09:42:17 +00:00
|
|
|
elif M == 109: #Set temperature, wait
|
|
|
|
pass
|
2012-02-28 14:02:24 +00:00
|
|
|
elif M == 113: #Extruder PWM (these should not be in the final GCode, but they are)
|
|
|
|
pass
|
|
|
|
else:
|
|
|
|
print "Unknown M code:" + str(M)
|
2012-03-29 09:01:33 +00:00
|
|
|
self.layerList.append(currentLayer)
|
2012-03-16 12:45:03 +00:00
|
|
|
self.extrusionAmount = maxExtrusion
|
2012-03-16 14:41:39 +00:00
|
|
|
self.totalMoveTimeMinute = totalMoveTimeMinute
|
2012-03-16 12:43:49 +00:00
|
|
|
print "Extruded a total of: %d mm of filament" % (self.extrusionAmount)
|
2012-03-16 14:41:39 +00:00
|
|
|
print "Estimated print duration: %.2f minutes" % (self.totalMoveTimeMinute)
|
2012-02-28 14:02:24 +00:00
|
|
|
|
2012-03-22 14:30:28 +00:00
|
|
|
def getCodeInt(self, line, code):
|
|
|
|
if code not in self.regMatch:
|
|
|
|
self.regMatch[code] = re.compile(code + '([^\s]+)')
|
|
|
|
m = self.regMatch[code].search(line)
|
2012-02-28 14:02:24 +00:00
|
|
|
if m == None:
|
|
|
|
return None
|
|
|
|
try:
|
|
|
|
return int(m.group(1))
|
|
|
|
except:
|
|
|
|
return None
|
|
|
|
|
2012-03-22 14:30:28 +00:00
|
|
|
def getCodeFloat(self, line, code):
|
|
|
|
if code not in self.regMatch:
|
|
|
|
self.regMatch[code] = re.compile(code + '([^\s]+)')
|
|
|
|
m = self.regMatch[code].search(line)
|
2012-02-28 14:02:24 +00:00
|
|
|
if m == None:
|
|
|
|
return None
|
|
|
|
try:
|
|
|
|
return float(m.group(1))
|
|
|
|
except:
|
|
|
|
return None
|
|
|
|
|
2012-03-22 14:30:28 +00:00
|
|
|
if __name__ == '__main__':
|
|
|
|
for filename in sys.argv[1:]:
|
2012-03-22 15:04:53 +00:00
|
|
|
gcode().load(filename)
|
2012-03-22 14:30:28 +00:00
|
|
|
|