522 lines
21 KiB
ObjectPascal
522 lines
21 KiB
ObjectPascal
program gcodegenerator_v3;
|
|
|
|
uses
|
|
SysUtils, StrUtils, Math;
|
|
|
|
type
|
|
TPoint = record
|
|
X, Y: double;
|
|
end;
|
|
|
|
type
|
|
TStatorParams = record
|
|
BaseDiameter: Double;
|
|
BaseRadius: Double;
|
|
NumberOfRays: Integer;
|
|
RayShape: string;
|
|
RayDiameter: Double;
|
|
RayWidth: Double;
|
|
RayHeight: Double;
|
|
RayLength: Double;
|
|
|
|
RayTopShape: string;
|
|
RayTopDiameter: Double;
|
|
RayTopWidth: Double;
|
|
RayTopHeight: Double;
|
|
|
|
RayCenterOffset: Double;
|
|
WireDiameter: Double;
|
|
NeedleDiameter: Double;
|
|
PathClearance: Double;
|
|
|
|
WorkSpeed :integer;
|
|
end;
|
|
|
|
var
|
|
InputFileName, OutputFileName: string;
|
|
StatorParams: TStatorParams;
|
|
InFile, OutFile: TextFile;
|
|
Line: string;
|
|
CoilRadius,CoilWidth,CoilHeight :double;
|
|
CurrentZ: double;
|
|
coords: TPoint;
|
|
normalizecoords: TPoint;
|
|
i, j, k: Integer;
|
|
CoilLength :double;
|
|
CurrentCoilTurns, CoilTurnsSum :Integer;
|
|
AngleBetweenRays :double;
|
|
RequiredSpacing: Double;
|
|
LayerNumber :Integer;
|
|
MaxLayers :Integer;
|
|
angle :double;
|
|
MaxDepth,MaxPath :double;
|
|
MoveForward:boolean;
|
|
|
|
|
|
|
|
function ParseLine(Line: string): Boolean;
|
|
var
|
|
Parts: array of string;
|
|
Value: string;
|
|
TrimmedLine: string;
|
|
begin
|
|
TrimmedLine := Trim(Line); // Óäàëÿåì ïðîáåëû â íà÷àëå è êîíöå ñòðîêè
|
|
if Length(TrimmedLine) = 0 then
|
|
begin
|
|
exit(true); // Ïóñòàÿ ñòðîêà - ïðîïóñêàåì
|
|
end
|
|
else if TrimmedLine[1] in [';','#'] then
|
|
begin
|
|
exit(true); // Ñòðîêà êîììåíòàðèÿ - ïðîïóñêàåì
|
|
end;
|
|
|
|
Parts := SplitString(TrimmedLine, '='); // Èñïîëüçóåì TrimmedLine
|
|
Result := Length(Parts) = 2;
|
|
if Result then
|
|
begin
|
|
Value := LowerCase(Trim(Parts[1])); // Ïðèâîäèì ê íèæíåìó ðåãèñòðó
|
|
case Trim(Parts[0]) of
|
|
'base_dia': begin
|
|
StatorParams.BaseDiameter := StrToFloat(Value);
|
|
writeln('Base Diameter: ', StatorParams.BaseDiameter:8:2);
|
|
writeln();
|
|
StatorParams.BaseRadius := StatorParams.BaseDiameter/2;
|
|
writeln('Base Radius: ', StatorParams.BaseRadius:8:2);
|
|
writeln();
|
|
|
|
end;
|
|
'num_rays': begin
|
|
StatorParams.NumberOfRays := StrToInt(Value);
|
|
writeln('Number of Rays: ', StatorParams.NumberOfRays);
|
|
AngleBetweenRays := 360/StatorParams.NumberOfRays;
|
|
writeln('Angle Between Rays: ', AngleBetweenRays);
|
|
writeln();
|
|
end;
|
|
'ray_shape': begin
|
|
if Pos(Value, 'circle, rect, superellipse') = 0 then
|
|
raise Exception.Create('Invalid value for ray_shape: ' + Value);
|
|
StatorParams.RayShape := Value;
|
|
writeln('Ray Shape: ', StatorParams.RayShape);
|
|
writeln();
|
|
end;
|
|
'ray_dia': begin
|
|
StatorParams.RayDiameter := StrToFloat(Value);
|
|
writeln('Ray Diameter: ', StatorParams.RayDiameter:8:2);
|
|
writeln();
|
|
end;
|
|
'ray_w': begin
|
|
StatorParams.RayWidth := StrToFloat(Value);
|
|
writeln('Ray Width: ', StatorParams.RayWidth:8:2);
|
|
writeln();
|
|
end;
|
|
'ray_h': begin
|
|
StatorParams.RayHeight := StrToFloat(Value);
|
|
writeln('Ray Height: ', StatorParams.RayHeight:8:2);
|
|
writeln();
|
|
end;
|
|
'ray_len': begin
|
|
StatorParams.RayLength := StrToFloat(Value);
|
|
writeln('Ray Length: ', StatorParams.RayLength:8:2);
|
|
writeln();
|
|
end;
|
|
|
|
'raytop_shape': begin
|
|
if Pos(Value, 'circle, rect, superellipse') = 0 then
|
|
raise Exception.Create('Invalid value for ray_top: ' + Value);
|
|
StatorParams.RayTopShape := Value;
|
|
writeln('Ray Top Shape: ', StatorParams.RayTopShape);
|
|
end;
|
|
|
|
'raytop_dia': begin
|
|
StatorParams.RayTopDiameter := StrToFloat(Value);
|
|
writeln('Ray Top Diameter: ', StatorParams.RayTopDiameter:8:2);
|
|
writeln();
|
|
end;
|
|
'raytop_w': begin
|
|
StatorParams.RayTopWidth := StrToFloat(Value);
|
|
writeln('Ray Top Width: ', StatorParams.RayTopWidth:8:2);
|
|
writeln();
|
|
end;
|
|
'raytop_h': begin
|
|
StatorParams.RayTopHeight := StrToFloat(Value);
|
|
writeln('Ray Top Height: ', StatorParams.RayTopHeight:8:2);
|
|
writeln();
|
|
end;
|
|
|
|
'ray_offset': begin
|
|
StatorParams.RayCenterOffset := StrToFloat(Value);
|
|
writeln('Ray Center Offset: ', StatorParams.RayCenterOffset:8:2);
|
|
writeln();
|
|
end;
|
|
'wire_diameter': begin
|
|
StatorParams.WireDiameter := StrToFloat(Value);
|
|
writeln('Wire Diameter: ', StatorParams.WireDiameter:8:2);
|
|
writeln();
|
|
end;
|
|
'needle_diameter': begin
|
|
StatorParams.NeedleDiameter := StrToFloat(Value);
|
|
writeln('Needle Diameter: ', StatorParams.NeedleDiameter:8:2);
|
|
writeln();
|
|
end;
|
|
'path_clearance': begin
|
|
StatorParams.PathClearance := StrToFloat(Value);
|
|
writeln('Path Clearance: ', StatorParams.PathClearance:8:2);
|
|
writeln();
|
|
end;
|
|
'work_speed': begin
|
|
StatorParams.WorkSpeed := StrToInt(Value);
|
|
writeln('Work Speed: ', StatorParams.WorkSpeed);
|
|
writeln();
|
|
end;
|
|
|
|
|
|
else
|
|
Result := False;
|
|
end;
|
|
if not Result then
|
|
begin
|
|
writeln('Error: Unknown parameter: ', Parts[0]);
|
|
exit;
|
|
end;
|
|
end;
|
|
end;
|
|
|
|
procedure ReadInputFile();
|
|
Begin
|
|
// **Opening the input file**
|
|
AssignFile(InFile, InputFileName);
|
|
try
|
|
Reset(InFile); // **This line opens the file for reading**
|
|
while not EOF(InFile) do
|
|
begin
|
|
ReadLn(InFile, Line);
|
|
if Length(Line) > 0 then
|
|
if not ParseLine(Line) then
|
|
writeln('Error: Invalid line: ', Line);
|
|
end;
|
|
except
|
|
on E: Exception do
|
|
begin
|
|
writeln('Error opening or reading input file: ', E.Message);
|
|
Halt(1);
|
|
end;
|
|
end;
|
|
CloseFile(InFile);
|
|
end;
|
|
|
|
function CircleCoordinates(diameter, angleDegrees: Double): TPoint;
|
|
var
|
|
radius: Double;
|
|
angleRadians: Double;
|
|
begin
|
|
radius := diameter / 2;
|
|
// angleRadians := -1*angleDegrees * PI / 180; // Ïåðåâîä ãðàäóñîâ â ðàäèàíû
|
|
angleRadians := -1 * DegToRad(angleDegrees);
|
|
|
|
Result.X := radius * Cos(angleRadians);
|
|
Result.Y := radius * Sin(angleRadians);
|
|
end;
|
|
|
|
function CalculateAngle(opposite, adjacent: Double): Double;
|
|
begin
|
|
if adjacent = 0 then
|
|
raise Exception.Create('Adjacent side cannot be zero');
|
|
// CalculateAngle := ArcTan(opposite / adjacent) * 180 / PI;
|
|
CalculateAngle := RadToDeg(ArcTan(opposite / adjacent));
|
|
end;
|
|
|
|
function NormalizeZ(radius: Real; thetaDeg: Real): Real;
|
|
var
|
|
thetaRad, alphaRad, xKas, yKas, mTang, bTang: Real;
|
|
begin
|
|
// 1. Ïðåîáðàçîâàíèå óãëà èç ãðàäóñîâ â ðàäèàíû.
|
|
thetaRad := DegToRad(thetaDeg);
|
|
|
|
// 2. Âû÷èñëåíèå êîîðäèíàò òî÷êè êàñàíèÿ íà îêðóæíîñòè (îòíîñèòåëüíî öåíòðà 0,0).
|
|
xKas := radius * Cos(thetaRad);
|
|
yKas := radius * Sin(thetaRad);
|
|
|
|
// 3. Âû÷èñëåíèå óãëà, ïåðïåíäèêóëÿðíîãî ðàäèóñ-âåêòîðó (êàñàòåëüíîé).
|
|
alphaRad := thetaRad + PI / 2;
|
|
|
|
// 4. Âû÷èñëåíèå óãëîâîãî êîýôôèöèåíòà êàñàòåëüíîé.
|
|
mTang := Tan(alphaRad);
|
|
|
|
// 5. Âû÷èñëåíèå ñâîáîäíîãî ÷ëåíà óðàâíåíèÿ êàñàòåëüíîé (y = mTang * x + bTang).
|
|
bTang := yKas - mTang * xKas;
|
|
|
|
// 6. Âû÷èñëåíèå êîîðäèíàòû X òî÷êè ïåðåñå÷åíèÿ êàñàòåëüíîé ñ îñüþ X (y = 0).
|
|
// 0 = mTang * x + bTang
|
|
// x = -bTang / mTang
|
|
if mTang = 0 then
|
|
begin
|
|
// Êàñàòåëüíàÿ ïàðàëëåëüíà îñè X - íåò òî÷êè ïåðåñå÷åíèÿ. Âîçâðàùàåì NaN.
|
|
NormalizeZ := NaN;
|
|
end
|
|
else
|
|
begin
|
|
NormalizeZ := -bTang / mTang;
|
|
end;
|
|
end;
|
|
|
|
function DepthCheck(thickness, lineLength, angleDeg: double): double;
|
|
var
|
|
xIntersection, distanceToIntersection, radius: double;
|
|
begin
|
|
xIntersection := (thickness/2 + thickness/2 * cos(DegToRad(angleDeg)))/sin(DegToRad(angleDeg));
|
|
distanceToIntersection := sqrt(sqr(xIntersection) + sqr(1.2));
|
|
radius := lineLength / (2 * tan(DegToRad(angleDeg) / 2));
|
|
DepthCheck := distanceToIntersection + radius;
|
|
end;
|
|
|
|
function CalculateMaxPath(length, width, angleDegrees: double): double;
|
|
var
|
|
topLeftX, topLeftY, rotatedX, rotatedY, angleRadians, distance: double;
|
|
begin
|
|
// Âû÷èñëÿåì êîîðäèíàòû âåðõíåãî ëåâîãî óãëà ïðÿìîóãîëüíèêà
|
|
topLeftX := -length;
|
|
topLeftY := width / 2;
|
|
|
|
// Ïðåîáðàçóåì óãîë â ðàäèàíû (ñ ó÷åòîì âðàùåíèÿ ïî ÷àñîâîé ñòðåëêå)
|
|
angleRadians := degToRad(-angleDegrees);
|
|
|
|
// Âû÷èñëÿåì êîîðäèíàòû ïîâåðíóòîãî íèæíåãî ëåâîãî óãëà âòîðîãî ïðÿìîóãîëüíèêà
|
|
rotatedX := -length * cos(angleRadians) - (-width / 2) * sin(angleRadians);
|
|
rotatedY := -length * sin(angleRadians) + (-width / 2) * cos(angleRadians);
|
|
|
|
// Âû÷èñëÿåì ðàññòîÿíèå ìåæäó òî÷êàìè
|
|
distance := sqrt(sqr(rotatedX - topLeftX) + sqr(rotatedY - topLeftY));
|
|
|
|
// Âîçâðàùàåì ðåçóëüòàò
|
|
MaxPath := distance;
|
|
end;
|
|
|
|
begin
|
|
// Command line argument handling
|
|
if ParamCount < 2 then
|
|
begin
|
|
Writeln('Usage: GCodeGenerator <input_file.txt> <output_file.gcode>');
|
|
Halt(1);
|
|
end;
|
|
InputFileName := ParamStr(1);
|
|
OutputFileName := ParamStr(2);
|
|
|
|
ReadInputFile();
|
|
|
|
// G-code generation
|
|
AssignFile(OutFile, OutputFileName);
|
|
try
|
|
Rewrite(OutFile);
|
|
// *** Your G-code generation logic here ***
|
|
writeln(OutFile, '; G-code for stator winding');
|
|
writeln(OutFile, 'G90 ; Absolute coordinate system');
|
|
writeln(OutFile, 'G1 Y-10');
|
|
writeln(OutFile, 'G28 X Y Z');
|
|
writeln(OutFile, 'G1 X0 Y0');
|
|
//writeln(OutFile, 'G28 O'); //Home all "untrusted" axes
|
|
writeln(OutFile);
|
|
// Move to center of ray along Y axis and reset coordinate
|
|
writeln(OutFile, 'G1 X', StatorParams.RayCenterOffset:0:2);
|
|
writeln(OutFile, 'G92 X0');
|
|
|
|
//îòâîäèì èãëó ëåâåå è íèæå âåðøèíû ëó÷à
|
|
CoilRadius:=(StatorParams.RayTopHeight/2+StatorParams.NeedleDiameter/2+StatorParams.PathClearance);
|
|
CoilWidth:=(StatorParams.RayTopWidth+StatorParams.NeedleDiameter+StatorParams.PathClearance*2);
|
|
CoilHeight:=(StatorParams.RayTopHeight+StatorParams.NeedleDiameter+StatorParams.PathClearance*2);
|
|
writeln(OutFile, ';CoilRadius = ', CoilRadius:0:3);
|
|
writeln(OutFile, ';CoilWidth = ', CoilWidth:0:3);
|
|
writeln(OutFile, ';CoilHeight = ', CoilHeight:0:3);
|
|
writeln(OutFile, 'G1 X', -1*CoilHeight/2:0:3, ' Y',-1*AngleBetweenRays/2:0:3);
|
|
|
|
//ïðèáëèæàåìñÿ ê îñíîâàíèþ ñòàòîðà.
|
|
CurrentZ:=(StatorParams.BaseDiameter/2)+StatorParams.PathClearance;
|
|
writeln(OutFile, 'G1 Z', CurrentZ:0:2, ' F', StatorParams.WorkSpeed);
|
|
//Âñòà¸ì íà ïàóçó äëÿ òîãî, ÷òîáû ïðèâÿçàòü êîíåö ïðîâîëîêè
|
|
writeln(OutFile, 'M0');
|
|
|
|
writeln(OutFile, ';Start coil');
|
|
//Íà÷èíàåì ìîòàòü êàòóøêó.
|
|
//Ñ÷èòàåì, ñêîëüêî ñëî¸â ìîæåì íàìîòàòü.
|
|
MaxPath:=CalculateMaxPath((StatorParams.RayLength+StatorParams.BaseRadius), StatorParams.RayWidth, AngleBetweenRays);
|
|
// MaxLayers :=trunc(((MaxPath-RequiredSpacing)/2/StatorParams.WireDiameter));
|
|
MaxLayers :=round(((MaxPath-RequiredSpacing)/2/StatorParams.WireDiameter));
|
|
writeln(OutFile, ';MaxLayers ', MaxLayers);
|
|
Inc(LayerNumber);
|
|
//Äâèãàåìñÿ îò öåíòðà ê êðàþ
|
|
MoveForward:=true;
|
|
if (StatorParams.RayShape = 'circle') then
|
|
begin
|
|
for j := 0 to CurrentCoilTurns do
|
|
begin
|
|
for i := 0 to 360 do
|
|
begin
|
|
coords := CircleCoordinates(CoilRadius*2, i+180);
|
|
// writeln(OutFile,'CoilRadius*2= ',CoilRadius*2:0:5,' X=', coords.X:0:3, ' Y=', coords.Y:0:5);
|
|
angle := CalculateAngle(coords.Y, CurrentZ);
|
|
|
|
// writeln(OutFile, ';G1 X', coords.X:0:3, ' Y', angle:0:5,' Z', CurrentZ:0:5);
|
|
writeln(OutFile, 'G1 X', coords.X:0:3, ' Y', angle:0:5,' Z', NormalizeZ(CurrentZ, angle):0:5);
|
|
// writeln(OutFile);
|
|
|
|
CurrentZ:=CurrentZ+StatorParams.WireDiameter/360;
|
|
end;
|
|
writeln(OutFile, ';Next coil.');
|
|
end;
|
|
writeln(OutFile, ';Second coil');
|
|
Inc(LayerNumber);
|
|
// RequiredSpacing:=StatorParams.RayWidth+StatorParams.NeedleDiameter+StatorParams.PathClearance*2+LayerNumber*StatorParams.WireDiameter*2;
|
|
// writeln(OutFile, ';RequiredSpacing = ',RequiredSpacing:0:5);
|
|
RequiredSpacing:=StatorParams.RayTopWidth;
|
|
writeln(OutFile, ';RequiredSpacing = ',RequiredSpacing:0:5);
|
|
RequiredSpacing:=RequiredSpacing+StatorParams.NeedleDiameter;
|
|
writeln(OutFile, ';RequiredSpacing = ',RequiredSpacing:0:5);
|
|
RequiredSpacing:=RequiredSpacing+StatorParams.PathClearance*2+LayerNumber*StatorParams.WireDiameter*2;
|
|
writeln(OutFile, ';RequiredSpacing = ',RequiredSpacing:0:5);
|
|
|
|
CurrentZ:=RequiredSpacing/(2 * tan(AngleBetweenRays*PI/180/2));
|
|
writeln(OutFile, ';CurrentZ = ',CurrentZ:0:3);
|
|
end
|
|
else if (StatorParams.RayShape = 'rect') then
|
|
begin
|
|
// writeln(OutFile, ';Rect? ');
|
|
while (LayerNumber <= MaxLayers) do
|
|
begin
|
|
//writeln(OutFile, ';Layer ', LayerNumber);
|
|
//Ñ÷èòàåì äëèíó êàòóøêè è êîëè÷åñòâî âèòêîâ
|
|
//Äëÿ ýòîãî ñ÷èòàåì íåîáõîäèìîå ðàññòîÿíèå ìåæäó ëó÷àìè. 2 äèàìåòðà ïðîâîäà + äèàìåòð èãëû + 2 çàçîðà áåçîïàñíîñòè
|
|
RequiredSpacing:=StatorParams.PathClearance*2+(LayerNumber-1)*StatorParams.WireDiameter*2+StatorParams.NeedleDiameter;
|
|
//Èñïîëüçóÿ íåîáõîäèìîå ðàññòîÿíèå, ðàññ÷èòûâàåì íà êàêóþ, ìàêñèìàëüíóþ ãëóáèíó ìîæåò ïîãðóçèòüñÿ èãîëêà. (ðàññòîÿíèå îò öåíòðà ñòàòîðà)
|
|
MaxDepth:=DepthCheck(StatorParams.RayWidth, RequiredSpacing, AngleBetweenRays);
|
|
writeln(OutFile, ';RayWidth ', StatorParams.RayWidth:0:5);
|
|
writeln(OutFile, ';RequiredSpacing ', RequiredSpacing:0:5);
|
|
writeln(OutFile, ';AngleBetweenRays ', AngleBetweenRays:0:5);
|
|
writeln(OutFile, ';MaxDepth ', MaxDepth:0:5);
|
|
writeln(OutFile);
|
|
//Åñëè äîïóñòèìàÿ ãëóáèíà ìåíüøå, ÷åì äèàìåòð îñíîâàíèÿ, òîãäà äëèíà êàòóøêè ðàâíà äëèíå ëó÷à.
|
|
//Åñëè äîïóñòèìàÿ ãëóáèíà áîëüøå, ÷åì äèàìåòð + äëèíà ëó÷à, ïðåêðàùàåì äâèæ.
|
|
//Èíà÷å äëèíà êàòóøêè ðàâíà "ðàäèóñ_îñíîâàíèÿ + äëèíà_ëó÷à - ãëóáèíà)
|
|
If (MaxDepth < (StatorParams.BaseRadius)) then CoilLength:=StatorParams.RayLength else if (MaxDepth > (StatorParams.RayLength+StatorParams.BaseRadius)) then break else
|
|
CoilLength:=StatorParams.RayLength+StatorParams.BaseRadius-MaxDepth;
|
|
writeln(OutFile, ';CoilLength ', CoilLength:0:5);
|
|
// CurrentCoilTurns := ceil(CoilLength/StatorParams.WireDiameter);
|
|
//Èñõîäÿ èç äëèíû êàòóøêè ñ÷èòàåì êîëè÷åñòâî âèòêîâ. È ñêëàäûâàåì ñêîëüêî âñåãî âèòêîâ íà êàòóøêå.
|
|
CurrentCoilTurns := round(CoilLength/StatorParams.WireDiameter);
|
|
writeln(OutFile, ';CurrentCoilTurns ', CurrentCoilTurns);
|
|
CoilTurnsSum := CoilTurnsSum+CurrentCoilTurns;
|
|
writeln(OutFile, ';CoilTurnsSum ', CoilTurnsSum);
|
|
writeln(OutFile);
|
|
//Ïåðåä êàæäûì ñëîåì íóæíî ïåðåñ÷èòàòü êîîðäèíàòó Z
|
|
write(OutFile,';RecalculateZ. CurrentZ=',CurrentZ:0:5);
|
|
if (MoveForward = false) then CurrentZ:=StatorParams.RayLength+StatorParams.BaseRadius-StatorParams.WireDiameter/2
|
|
else CurrentZ:=StatorParams.RayLength+StatorParams.BaseRadius-StatorParams.WireDiameter*(CurrentCoilTurns-0.5);
|
|
writeln(OutFile,'; NewZ=',CurrentZ:0:5);
|
|
//Íà÷èíàåì ìîòàòü.
|
|
writeln(OutFile, ';We make ',CurrentCoilTurns, ' turns on ', LayerNumber, ' layer.' );
|
|
for j := 1 to CurrentCoilTurns do
|
|
begin
|
|
writeln(OutFile,';Coil¹ = ',j);
|
|
writeln(OutFile,'M117 ',j);
|
|
//angle := CalculateAngle(CoilWidth/2, CurrentZ);
|
|
angle := AngleBetweenRays/2;
|
|
|
|
//Divide the path into 100 points
|
|
//Move from left-down to left-up
|
|
for k := 1 to 100 do
|
|
begin
|
|
angle := AngleBetweenRays/2;
|
|
angle := ((-1*angle)+2*(angle/100*k));
|
|
writeln(OutFile, 'G1 X', -1*CoilHeight/2:0:3, ' Y', angle:0:5,' Z', NormalizeZ(CurrentZ, angle):0:5, ' ;CurrentZ= ',CurrentZ:0:5); // Top Left Corner
|
|
end;
|
|
if MoveForward then CurrentZ:=CurrentZ+StatorParams.WireDiameter/4 else CurrentZ:=CurrentZ-StatorParams.WireDiameter/4;
|
|
|
|
// writeln(OutFile, 'G1 X', -1*CoilHeight/2:0:3, ' Y', angle:0:5,' Z', NormalizeZ(CurrentZ, angle):0:5); // Top Left Corner
|
|
// if MoveForward then CurrentZ:=CurrentZ+StatorParams.WireDiameter/4 else CurrentZ:=CurrentZ-StatorParams.WireDiameter/4;
|
|
//writeln(OutFile, 'M0');
|
|
|
|
// angle := CalculateAngle(CoilWidth/2, CurrentZ);
|
|
angle := AngleBetweenRays/2;
|
|
writeln(OutFile, 'G1 X', CoilHeight/2:0:3, ' Y', angle:0:5,' Z', NormalizeZ(CurrentZ, angle):0:5, ' ;CurrentZ= ',CurrentZ:0:5); // Top Right Corner
|
|
if MoveForward then CurrentZ:=CurrentZ+StatorParams.WireDiameter/4 else CurrentZ:=CurrentZ-StatorParams.WireDiameter/4;
|
|
//writeln(OutFile, 'M0');
|
|
|
|
//Divide the path into 100 points
|
|
//Move from left-down to rt-up
|
|
for k := 1 to 100 do
|
|
begin
|
|
angle := AngleBetweenRays/2;
|
|
angle := (angle-(2*(angle/100*k)));
|
|
writeln(OutFile, 'G1 X', CoilHeight/2:0:3, ' Y', angle:0:5,' Z', NormalizeZ(CurrentZ, angle):0:5, ' ;CurrentZ= ',CurrentZ:0:5); // Bottom Right Corner
|
|
end;
|
|
if MoveForward then CurrentZ:=CurrentZ+StatorParams.WireDiameter/4 else CurrentZ:=CurrentZ-StatorParams.WireDiameter/4;
|
|
|
|
// angle := CalculateAngle(-1*CoilWidth/2, CurrentZ);
|
|
// writeln(OutFile, 'G1 X', CoilHeight/2:0:3, ' Y', -angle:0:5,' Z', NormalizeZ(CurrentZ, angle):0:5); // Bottom Right Corner
|
|
// if MoveForward then CurrentZ:=CurrentZ+StatorParams.WireDiameter/4 else CurrentZ:=CurrentZ-StatorParams.WireDiameter/4;
|
|
//writeln(OutFile, 'M0');
|
|
|
|
// angle := CalculateAngle(CoilWidth/2, CurrentZ);
|
|
angle := AngleBetweenRays/2;
|
|
writeln(OutFile, 'G1 X', -1*CoilHeight/2:0:3, ' Y', -angle:0:5,' Z', NormalizeZ(CurrentZ, angle):0:5, ' ;CurrentZ= ',CurrentZ:0:5); // Bottom Left Corner
|
|
if MoveForward then CurrentZ:=CurrentZ+StatorParams.WireDiameter/4 else CurrentZ:=CurrentZ-StatorParams.WireDiameter/4;
|
|
//writeln(OutFile, 'M0');
|
|
end;
|
|
|
|
writeln(OutFile, 'M0');
|
|
// writeln(OutFile, 'G91');
|
|
// writeln(OutFile, 'G1 Y50');
|
|
// writeln(OutFile, 'G90');
|
|
Inc(LayerNumber);
|
|
CoilWidth:=CoilWidth+StatorParams.WireDiameter*2;
|
|
MoveForward:= not MoveForward;
|
|
writeln(OutFile,';MoveForward: ', MoveForward);
|
|
end;
|
|
|
|
|
|
(* writeln(OutFile);
|
|
writeln(OutFile, ';Second coil');
|
|
Inc(LayerNumber);
|
|
RequiredSpacing:=StatorParams.PathClearance*2+LayerNumber*StatorParams.WireDiameter*2+StatorParams.NeedleDiameter;
|
|
writeln(OutFile, ';RequiredSpacing = ',RequiredSpacing:0:5);
|
|
|
|
For i:=1 to 20 do
|
|
begin
|
|
LayerNumber:=i;
|
|
writeln(OutFile, ';Layer ', i);
|
|
RequiredSpacing:=StatorParams.PathClearance*2+(LayerNumber-1)*StatorParams.WireDiameter*2+StatorParams.NeedleDiameter;
|
|
writeln(OutFile, ';RequiredSpacing ', RequiredSpacing:0:5);
|
|
|
|
MaxDepth:=DepthCheck(StatorParams.RayWidth, RequiredSpacing, AngleBetweenRays);
|
|
writeln(OutFile, ';MaxDepth ', MaxDepth:0:5);
|
|
|
|
If (MaxDepth < (StatorParams.BaseRadius)) then CoilLength:=StatorParams.RayLength else if (MaxDepth > (StatorParams.RayLength+StatorParams.BaseRadius)) then break else
|
|
CoilLength:=StatorParams.RayLength+StatorParams.BaseRadius-MaxDepth;
|
|
writeln(OutFile, ';CoilLength ', CoilLength:0:5);
|
|
|
|
// CurrentCoilTurns := round(CoilLength/StatorParams.WireDiameter);
|
|
// CurrentCoilTurns := ceil(CoilLength/StatorParams.WireDiameter);
|
|
CurrentCoilTurns := floor(CoilLength/StatorParams.WireDiameter);
|
|
writeln(OutFile, ';CurrentCoilTurns ', CurrentCoilTurns);
|
|
|
|
CoilTurnsSum := CoilTurnsSum+CurrentCoilTurns;
|
|
writeln(OutFile, ';CoilTurnsSum ', CoilTurnsSum);
|
|
writeln(OutFile);
|
|
end;*)
|
|
|
|
end;
|
|
|
|
|
|
|
|
// *** Your G-code generation logic here ***
|
|
except
|
|
on E: Exception do
|
|
begin
|
|
writeln('Error writing to output file: ', E.Message);
|
|
Halt(1);
|
|
end;
|
|
end;
|
|
CloseFile(OutFile);
|
|
|
|
writeln('G-code generated to: ', OutputFileName);
|
|
writeln('Press Enter... ');
|
|
Readln;
|
|
end.
|