public GCodePlanner(GCodeExport gcode, int travelSpeed, int retractionMinimumDistance)
{
this.gcode = gcode;
travelConfig = new GCodePathConfig(travelSpeed, 0, "travel");
lastPosition = gcode.getPositionXY();
outerPerimetersToAvoidCrossing = null;
extrudeSpeedFactor = 100;
travelSpeedFactor = 100;
extraTime = 0.0;
totalPrintTime = 0.0;
forceRetraction = false;
alwaysRetract = false;
currentExtruderIndex = gcode.getExtruderIndex();
this.retractionMinimumDistance = retractionMinimumDistance;
}
public void writeGCode(bool liftHeadIfNeeded, int layerThickness)
{
GCodePathConfig lastConfig = null;
int extruderIndex = gcode.getExtruderIndex();
for (int pathIndex = 0; pathIndex < paths.Count; pathIndex++)
{
GCodePath path = paths[pathIndex];
if (extruderIndex != path.extruderIndex)
{
extruderIndex = path.extruderIndex;
gcode.switchExtruder(extruderIndex);
}
else if (path.Retract)
{
gcode.writeRetraction();
}
if (path.config != travelConfig && lastConfig != path.config)
{
gcode.writeComment("TYPE:{0}".FormatWith(path.config.name));
lastConfig = path.config;
}
int speed = path.config.speed;
if (path.config.lineWidth != 0)
{
// Only apply the extrudeSpeedFactor to extrusion moves
speed = speed * extrudeSpeedFactor / 100;
}
else
{
speed = speed * travelSpeedFactor / 100;
}
if (path.points.Count == 1 &&
path.config != travelConfig &&
(gcode.getPositionXY() - path.points[0]).ShorterThen(path.config.lineWidth * 2))
{
//Check for lots of small moves and combine them into one large line
IntPoint nextPosition = path.points[0];
int i = pathIndex + 1;
while (i < paths.Count && paths[i].points.Count == 1 && (nextPosition - paths[i].points[0]).ShorterThen(path.config.lineWidth * 2))
{
nextPosition = paths[i].points[0];
i++;
}
if (paths[i - 1].config == travelConfig)
{
i--;
}
if (i > pathIndex + 2)
{
nextPosition = gcode.getPositionXY();
for (int x = pathIndex; x < i - 1; x += 2)
{
long oldLen = (nextPosition - paths[x].points[0]).vSize();
IntPoint newPoint = (paths[x].points[0] + paths[x + 1].points[0]) / 2;
long newLen = (gcode.getPositionXY() - newPoint).vSize();
if (newLen > 0)
{
gcode.writeMove(newPoint, speed, (int)(path.config.lineWidth * oldLen / newLen));
}
nextPosition = paths[x + 1].points[0];
}
gcode.writeMove(paths[i - 1].points[0], speed, path.config.lineWidth);
pathIndex = i - 1;
continue;
}
}
bool spiralize = path.config.spiralize;
if (spiralize)
{
//Check if we are the last spiralize path in the list, if not, do not spiralize.
for (int m = pathIndex + 1; m < paths.Count; m++)
{
if (paths[m].config.spiralize)
{
spiralize = false;
}
}
}
if (spiralize)
{
//If we need to spiralize then raise the head slowly by 1 layer as this path progresses.
double totalLength = 0;
int z = gcode.getPositionZ();
IntPoint currentPosition = gcode.getPositionXY();
for (int pointIndex = 0; pointIndex < path.points.Count; pointIndex++)
{
IntPoint nextPosition = path.points[pointIndex];
totalLength += (currentPosition - nextPosition).LengthMm();
currentPosition = nextPosition;
}
double length = 0.0;
currentPosition = gcode.getPositionXY();
for (int i = 0; i < path.points.Count; i++)
{
IntPoint nextPosition = path.points[i];
length += (currentPosition - nextPosition).LengthMm();
currentPosition = nextPosition;
gcode.setZ((int)(z + layerThickness * length / totalLength + .5));
gcode.writeMove(path.points[i], speed, path.config.lineWidth);
}
}
else
{
for (int pointIndex = 0; pointIndex < path.points.Count; pointIndex++)
{
gcode.writeMove(path.points[pointIndex], speed, path.config.lineWidth);
}
}
}
gcode.updateTotalPrintTime();
if (liftHeadIfNeeded && extraTime > 0.0)
{
gcode.writeComment("Small layer, adding delay of {0}".FormatWith(extraTime));
gcode.writeRetraction();
gcode.setZ(gcode.getPositionZ() + 3000);
gcode.writeMove(gcode.getPositionXY(), travelConfig.speed, 0);
gcode.writeMove(gcode.getPositionXY() - new IntPoint(-20000, 0), travelConfig.speed, 0);
gcode.writeDelay(extraTime);
}
}