private static string GetPolynomialGCode(ref float backlashCompensationX, ref float backlashCompensationY, ref BacklashCalibrationPrint.Direction dirXPrev, ref BacklashCalibrationPrint.Direction dirYPrev, float XStart, float YStart, Position pos, int points, float radius, float X_BACKLASH, float Y_BACKLASH, float layerHeight, float EXTRUSION_PER_MM_XY, bool isFirstMove)
{
var stringBuilder = new StringBuilder();
var num1 = (float)(360.0 / points * (Math.PI / 180.0));
var num2 = layerHeight / points;
for (var index = 0; index < points; ++index)
{
var num3 = (float)(45.0 + index * (double)num1);
var num4 = XStart + radius * Math.Cos(num3);
var num5 = YStart + radius * Math.Sin(num3);
var num6 = (float)num4 - pos.relativeX;
var num7 = (float)num5 - pos.relativeY;
var num8 = (float)Math.Sqrt(num6 * (double)num6 + num7 * (double)num7) * EXTRUSION_PER_MM_XY;
if (isFirstMove)
{
isFirstMove = false;
num8 = 0.0f;
}
pos.relativeE += num8;
pos.absoluteE += num8;
pos.relativeZ += num2;
BacklashCalibrationPrint.Direction direction1 = num6 <= 1.40129846432482E-45 ? num6 >= -1.40129846432482E-45 ? dirXPrev : BacklashCalibrationPrint.Direction.Negative : BacklashCalibrationPrint.Direction.Positive;
BacklashCalibrationPrint.Direction direction2 = num7 <= 1.40129846432482E-45 ? num7 >= -1.40129846432482E-45 ? dirYPrev : BacklashCalibrationPrint.Direction.Negative : BacklashCalibrationPrint.Direction.Positive;
if (direction1 != dirXPrev && dirXPrev != BacklashCalibrationPrint.Direction.Neither || direction2 != dirYPrev && dirYPrev != BacklashCalibrationPrint.Direction.Neither)
{
if (direction1 != dirXPrev && dirXPrev != BacklashCalibrationPrint.Direction.Neither)
{
backlashCompensationX += direction1 == BacklashCalibrationPrint.Direction.Positive ? X_BACKLASH : -X_BACKLASH;
}
if (direction2 != dirYPrev && dirYPrev != BacklashCalibrationPrint.Direction.Neither)
{
backlashCompensationY += direction2 == BacklashCalibrationPrint.Direction.Positive ? Y_BACKLASH : -Y_BACKLASH;
}
var num9 = pos.relativeX + backlashCompensationX;
var num10 = pos.relativeY + backlashCompensationY;
stringBuilder.AppendLine(PrinterCompatibleString.Format("G0 X{0:0.0000} Y{1:0.0000} F{2} ;X_BACKLASH:{3:0.000} ;Y_BACKLASH:{4:0.000}", num9, num10, 500, X_BACKLASH, Y_BACKLASH));
}
var num11 = (float)num4 + backlashCompensationX;
var num12 = (float)num5 + backlashCompensationY;
stringBuilder.AppendLine(PrinterCompatibleString.Format("G0 X{0:0.0000} Y{1:0.0000} Z{2:0.0000} E{3:0.0000} F{4}", num11, num12, pos.relativeZ, pos.relativeE, 500));
pos.relativeX += num6;
pos.relativeY += num7;
pos.absoluteX += num6;
pos.absoluteY += num7;
dirXPrev = direction1;
dirYPrev = direction2;
}
return(stringBuilder.ToString());
}
public static void Create(string filename, FilamentSpool.TypeEnum filament_type, float XStart, float YStart)
{
var num1 = 215;
switch (filament_type)
{
case FilamentSpool.TypeEnum.ABS:
num1 = 270;
break;
case FilamentSpool.TypeEnum.HIPS:
num1 = 260;
break;
case FilamentSpool.TypeEnum.ABS_R:
num1 = 240;
break;
}
BacklashCalibrationPrint.Direction dirXPrev = BacklashCalibrationPrint.Direction.Neither;
BacklashCalibrationPrint.Direction dirYPrev = BacklashCalibrationPrint.Direction.Neither;
using (var fileStream = new FileStream(filename, FileMode.Create, FileAccess.Write))
{
using (var streamWriter = new StreamWriter(fileStream))
{
streamWriter.WriteLine("G90");
streamWriter.WriteLine("M104 S" + num1);
streamWriter.WriteLine("G28");
streamWriter.WriteLine("G0 Z2 F60");
streamWriter.WriteLine("M109 S" + num1);
switch (filament_type)
{
case FilamentSpool.TypeEnum.ABS:
streamWriter.WriteLine("M106 S1");
break;
case FilamentSpool.TypeEnum.PLA:
case FilamentSpool.TypeEnum.FLX:
case FilamentSpool.TypeEnum.TGH:
streamWriter.WriteLine("M106 S255");
break;
}
var backlashCompensationX = 0.0f;
var backlashCompensationY = 0.0f;
var points1 = 4;
var num2 = 8f;
var layerHeight = 0.2f;
var pos = new Position
{
relativeX = XStart,
relativeY = YStart,
relativeZ = 0.4f
};
streamWriter.WriteLine(PrinterCompatibleString.Format("G0 X{0:0.0000} Y{1:0.0000} F500", XStart, YStart));
var isFirstMove = false;
for (var index1 = 0; index1 < 5; ++index1)
{
streamWriter.WriteLine(PrinterCompatibleString.Format("G0 Z{0:0.000}", (object)pos.relativeZ));
pos.relativeZ += 0.2f;
for (var index2 = 0; index2 < 5; ++index2)
{
float EXTRUSION_PER_MM_XY;
switch (index1)
{
case 0:
EXTRUSION_PER_MM_XY = 0.2508f;
break;
case 1:
EXTRUSION_PER_MM_XY = 0.0528f;
break;
default:
EXTRUSION_PER_MM_XY = 0.044f;
break;
}
var polynomialGcode = BacklashCalibrationPrint.GetPolynomialGCode(ref backlashCompensationX, ref backlashCompensationY, ref dirXPrev, ref dirYPrev, XStart, YStart, pos, points1, num2 - index2, 0.25f, 1.06f, 0.0f, EXTRUSION_PER_MM_XY, isFirstMove);
isFirstMove = false;
streamWriter.WriteLine(polynomialGcode);
}
}
streamWriter.WriteLine("M106 s255");
var points2 = 96;
var radius = 5f;
var num3 = (int)(Math.Ceiling(30.0 / layerHeight) + 0.100000001490116);
var num4 = 1f;
var num5 = 2f;
var num6 = num4 / num3;
var num7 = num5 / num3;
var X_BACKLASH = 0.0f;
var Y_BACKLASH = 0.0f;
var num8 = 0;
while (X_BACKLASH < (double)num4 && Y_BACKLASH < (double)num5)
{
streamWriter.WriteLine(PrinterCompatibleString.Format("G0 Z{0:0.000}", (object)pos.relativeZ));
var polynomialGcode = BacklashCalibrationPrint.GetPolynomialGCode(ref backlashCompensationX, ref backlashCompensationY, ref dirXPrev, ref dirYPrev, XStart, YStart, pos, points2, radius, X_BACKLASH, Y_BACKLASH, layerHeight, 0.0369f, false);
streamWriter.WriteLine(polynomialGcode);
X_BACKLASH += num6;
Y_BACKLASH += num7;
++num8;
}
pos.relativeZ += 4f;
streamWriter.WriteLine("M104 S0");
streamWriter.WriteLine(";PrinterJob");
streamWriter.WriteLine(PrinterCompatibleString.Format("G0 Z{0:0.000}", (object)pos.relativeZ));
streamWriter.WriteLine("G91");
streamWriter.WriteLine("G0 X20 Y20");
streamWriter.WriteLine("M18");
}
}
}
