Split out thread milling generator into its own file
This commit is contained in:
@@ -28,6 +28,7 @@ import PathScripts.PathCircularHoleBase as PathCircularHoleBase
|
||||
import PathScripts.PathGeom as PathGeom
|
||||
import PathScripts.PathLog as PathLog
|
||||
import PathScripts.PathOp as PathOp
|
||||
import Generators.threadmilling_generator as threadmilling
|
||||
import math
|
||||
from PySide.QtCore import QT_TRANSLATE_NOOP
|
||||
|
||||
@@ -117,172 +118,6 @@ def elevatorRadius(obj, center, internal, tool):
|
||||
return dy
|
||||
|
||||
|
||||
def comment(path, msg):
|
||||
if False:
|
||||
path.append(Path.Command("(------- {} -------)".format(msg)))
|
||||
|
||||
|
||||
class _Thread(object):
|
||||
"""Helper class for dealing with different thread types"""
|
||||
|
||||
def __init__(self, cmd, zStart, zFinal, pitch, internal):
|
||||
self.cmd = cmd
|
||||
if zStart < zFinal:
|
||||
self.pitch = pitch
|
||||
else:
|
||||
self.pitch = -pitch
|
||||
self.hPitch = self.pitch / 2
|
||||
self.zStart = zStart
|
||||
self.zFinal = zFinal
|
||||
self.internal = internal
|
||||
|
||||
def overshoots(self, z):
|
||||
"""overshoots(z) ... returns true if adding another half helix goes beyond the thread bounds"""
|
||||
if self.pitch < 0:
|
||||
return z + self.hPitch < self.zFinal
|
||||
return z + self.hPitch > self.zFinal
|
||||
|
||||
def adjustX(self, x, dx):
|
||||
"""adjustX(x, dx) ... move x by dx, the direction depends on the thread settings"""
|
||||
if self.isG3() == (self.pitch > 0):
|
||||
return x + dx
|
||||
return x - dx
|
||||
|
||||
def adjustY(self, y, dy):
|
||||
"""adjustY(y, dy) ... move y by dy, the direction depends on the thread settings"""
|
||||
if self.isG3():
|
||||
return y - dy
|
||||
return y - dy
|
||||
|
||||
def isG3(self):
|
||||
"""isG3() ... returns True if this is a G3 command"""
|
||||
return self.cmd in ["G3", "G03", "g3", "g03"]
|
||||
|
||||
def isUp(self):
|
||||
"""isUp() ... returns True if the thread goes from the bottom up"""
|
||||
return self.pitch > 0
|
||||
|
||||
def g4Opposite(self):
|
||||
return "G2" if self.isG3() else "G3"
|
||||
|
||||
def g4LeadInOut(self):
|
||||
if self.internal:
|
||||
return self.cmd
|
||||
return self.g4Opposite()
|
||||
|
||||
def g4Start2Elevator(self):
|
||||
return self.g4Opposite()
|
||||
|
||||
|
||||
def threadCommands(
|
||||
center, cmd, zStart, zFinal, pitch, radius, leadInOut, elevator, start
|
||||
):
|
||||
"""threadCommands(center, cmd, zStart, zFinal, pitch, radius) ... returns the g-code to mill the given internal thread"""
|
||||
thread = _Thread(cmd, zStart, zFinal, pitch, radius > elevator)
|
||||
|
||||
yMin = center.y - radius
|
||||
yMax = center.y + radius
|
||||
|
||||
path = []
|
||||
# at this point the tool is at a safe heiht (depending on the previous thread), so we can move
|
||||
# into position first, and then drop to the start height. If there is any material in the way this
|
||||
# op hasn't been setup properly.
|
||||
if leadInOut:
|
||||
comment(path, "lead-in")
|
||||
if start is None:
|
||||
path.append(Path.Command("G0", {"X": center.x, "Y": center.y + elevator}))
|
||||
path.append(Path.Command("G0", {"Z": thread.zStart}))
|
||||
else:
|
||||
path.append(
|
||||
Path.Command(
|
||||
thread.g4Start2Elevator(),
|
||||
{
|
||||
"X": center.x,
|
||||
"Y": center.y + elevator,
|
||||
"Z": thread.zStart,
|
||||
"I": (center.x - start.x) / 2,
|
||||
"J": (center.y + elevator - start.y) / 2,
|
||||
"K": (thread.zStart - start.z) / 2,
|
||||
},
|
||||
)
|
||||
)
|
||||
path.append(
|
||||
Path.Command(
|
||||
thread.g4LeadInOut(),
|
||||
{"Y": yMax, "J": (yMax - (center.y + elevator)) / 2},
|
||||
)
|
||||
)
|
||||
comment(path, "lead-in")
|
||||
else:
|
||||
if start is None:
|
||||
path.append(Path.Command("G0", {"X": center.x, "Y": center.y + elevator}))
|
||||
path.append(Path.Command("G0", {"Z": thread.zStart}))
|
||||
else:
|
||||
path.append(
|
||||
Path.Command(
|
||||
"G0", {"X": center.x, "Y": center.y + elevator, "Z": thread.zStart}
|
||||
)
|
||||
)
|
||||
path.append(Path.Command("G1", {"Y": yMax}))
|
||||
|
||||
z = thread.zStart
|
||||
r = -radius
|
||||
i = 0
|
||||
while not PathGeom.isRoughly(z, thread.zFinal):
|
||||
if thread.overshoots(z):
|
||||
break
|
||||
if 0 == (i & 0x01):
|
||||
y = yMin
|
||||
else:
|
||||
y = yMax
|
||||
path.append(Path.Command(thread.cmd, {"Y": y, "Z": z + thread.hPitch, "J": r}))
|
||||
r = -r
|
||||
i = i + 1
|
||||
z = z + thread.hPitch
|
||||
|
||||
if PathGeom.isRoughly(z, thread.zFinal):
|
||||
x = center.x
|
||||
y = yMin if (i & 0x01) else yMax
|
||||
else:
|
||||
n = math.fabs(thread.zFinal - thread.zStart) / thread.hPitch
|
||||
k = n - int(n)
|
||||
dy = math.cos(k * math.pi)
|
||||
dx = math.sin(k * math.pi)
|
||||
y = thread.adjustY(center.y, r * dy)
|
||||
x = thread.adjustX(center.x, r * dx)
|
||||
comment(path, "finish-thread")
|
||||
path.append(
|
||||
Path.Command(thread.cmd, {"X": x, "Y": y, "Z": thread.zFinal, "J": r})
|
||||
)
|
||||
comment(path, "finish-thread")
|
||||
|
||||
a = math.atan2(y - center.y, x - center.x)
|
||||
dx = math.cos(a) * (radius - elevator)
|
||||
dy = math.sin(a) * (radius - elevator)
|
||||
PathLog.debug("")
|
||||
PathLog.debug("a={}: dx={:.2f}, dy={:.2f}".format(a / math.pi * 180, dx, dy))
|
||||
|
||||
elevatorX = x - dx
|
||||
elevatorY = y - dy
|
||||
PathLog.debug(
|
||||
"({:.2f}, {:.2f}) -> ({:.2f}, {:.2f})".format(x, y, elevatorX, elevatorY)
|
||||
)
|
||||
|
||||
if leadInOut:
|
||||
comment(path, "lead-out")
|
||||
path.append(
|
||||
Path.Command(
|
||||
thread.g4LeadInOut(),
|
||||
{"X": elevatorX, "Y": elevatorY, "I": -dx / 2, "J": -dy / 2},
|
||||
)
|
||||
)
|
||||
comment(path, "lead-out")
|
||||
else:
|
||||
path.append(Path.Command("G1", {"X": elevatorX, "Y": elevatorY}))
|
||||
|
||||
return (path, FreeCAD.Vector(elevatorX, elevatorY, thread.zFinal))
|
||||
|
||||
|
||||
class ObjectThreadMilling(PathCircularHoleBase.ObjectOp):
|
||||
"""Proxy object for thread milling operation."""
|
||||
|
||||
@@ -594,7 +429,7 @@ class ObjectThreadMilling(PathCircularHoleBase.ObjectOp):
|
||||
# shortcuts when moving to the elevator position
|
||||
self.commandlist.append(move2clearance)
|
||||
start = None
|
||||
commands, start = threadCommands(
|
||||
commands, start = threadmilling.generate(
|
||||
loc,
|
||||
gcode,
|
||||
zStart,
|
||||
|
||||
Reference in New Issue
Block a user