Add files via upload
This commit is contained in:
614
src/Mod/Path/PathScripts/post/marlin_post.py
Normal file
614
src/Mod/Path/PathScripts/post/marlin_post.py
Normal file
@@ -0,0 +1,614 @@
|
||||
# -*- coding: utf-8 -*-
|
||||
# ***************************************************************************
|
||||
# * *
|
||||
# * (c) sliptonic (shopinthewoods@gmail.com) 2014 *
|
||||
# * (c) Gauthier Briere - 2018, 2019 *
|
||||
# * (c) Schildkroet - 2019-2020 *
|
||||
# * (c) Gary L Hasson - 2020 *
|
||||
# * *
|
||||
# * This file is part of the FreeCAD CAx development system. *
|
||||
# * *
|
||||
# * This program is free software; you can redistribute it and/or modify *
|
||||
# * it under the terms of the GNU Lesser General Public License (LGPL) *
|
||||
# * as published by the Free Software Foundation; either version 2 of *
|
||||
# * the License, or (at your option) any later version. *
|
||||
# * for detail see the LICENCE text file. *
|
||||
# * *
|
||||
# * FreeCAD is distributed in the hope that it will be useful, *
|
||||
# * but WITHOUT ANY WARRANTY; without even the implied warranty of *
|
||||
# * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
|
||||
# * GNU Lesser General Public License for more details. *
|
||||
# * *
|
||||
# * You should have received a copy of the GNU Library General Public *
|
||||
# * License along with FreeCAD; if not, write to the Free Software *
|
||||
# * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 *
|
||||
# * USA *
|
||||
# * *
|
||||
# ***************************************************************************/
|
||||
|
||||
# This file is derived from grbl_post.py.
|
||||
|
||||
import FreeCAD
|
||||
from FreeCAD import Units
|
||||
import PathScripts.PostUtils as PostUtils
|
||||
import argparse
|
||||
import datetime
|
||||
import shlex
|
||||
import PathScripts.PathUtil as PathUtil
|
||||
|
||||
|
||||
TOOLTIP = '''
|
||||
Generate g-code from a Path that is compatible with the Marlin controller.
|
||||
import marlin_post
|
||||
marlin_post.export(object, "/path/to/file.nc")
|
||||
'''
|
||||
|
||||
# ***************************************************************************
|
||||
# * Globals set customization preferences
|
||||
# ***************************************************************************
|
||||
|
||||
Revised = "2020-10-18" # Revision date for this file.
|
||||
|
||||
# Default values for command line arguments:
|
||||
OUTPUT_COMMENTS = True # default output of comments in output gcode file
|
||||
OUTPUT_FINISH = False # include an operation finished comment
|
||||
OUTPUT_PATH = False # include a Path: comment
|
||||
OUTPUT_HEADER = True # default output header in output gcode file
|
||||
OUTPUT_LINE_NUMBERS = False # default doesn't output line numbers in output gcode file
|
||||
OUTPUT_BCNC = False # default doesn't add bCNC operation block headers in output gcode file
|
||||
SHOW_EDITOR = True # default show the resulting file dialog output in GUI
|
||||
PRECISION = 3 # Default precision for metric (see http://linuxcnc.org/docs/2.7/html/gcode/overview.html#_g_code_best_practices)
|
||||
TRANSLATE_DRILL_CYCLES = True # If true, G81, G82 & G83 are translated into G0/G1 moves
|
||||
|
||||
# Marlin 2.x ignores commands that it does not implement.
|
||||
# Marlin 2.x ignores the ENTIRE COMMAND LINE if there is more than one command per line.
|
||||
# Default preamble text will appear at the beginning of the gcode output file.
|
||||
PREAMBLE = '''G80
|
||||
G17
|
||||
G90
|
||||
'''
|
||||
|
||||
# Default postamble text will appear following the last operation.
|
||||
POSTAMBLE = '''G80
|
||||
M5
|
||||
G17
|
||||
G90
|
||||
'''
|
||||
|
||||
SPINDLE_WAIT = 0 # no waiting after M3 / M4 by default
|
||||
RETURN_TO = None # no movements after end of program
|
||||
|
||||
# Customisation with no command line argument
|
||||
MODAL = False # if true commands are suppressed if the same as previous line.
|
||||
LINENR = 100 # line number starting value
|
||||
LINEINCR = 10 # line number increment
|
||||
OUTPUT_TOOL_CHANGE = False # default don't output M6 tool changes (comment it) as Marlin currently does not handle it
|
||||
DRILL_RETRACT_MODE = 'G98' # Default value of drill retractations (CURRENT_Z) other possible value is G99
|
||||
MOTION_MODE = 'G90' # G90 for absolute moves, G91 for relative
|
||||
UNITS = 'G21' # G21 for metric, G20 for USA standard
|
||||
UNIT_FORMAT = 'mm'
|
||||
UNIT_SPEED_FORMAT = 'mm/min'
|
||||
PRE_OPERATION = '''''' # Pre operation text will be inserted before every operation
|
||||
POST_OPERATION = '''''' # Post operation text will be inserted after every operation
|
||||
TOOL_CHANGE = '''''' # Tool Change commands will be inserted before a tool change
|
||||
|
||||
# ***************************************************************************
|
||||
# * End of customization
|
||||
# ***************************************************************************
|
||||
|
||||
# Parser arguments list & definition:
|
||||
parser = argparse.ArgumentParser(prog='Marlin', add_help=False)
|
||||
parser.add_argument('--comments', action='store_true', help='output comment (default)')
|
||||
parser.add_argument('--no-comments', action='store_true', help='suppress comment output')
|
||||
parser.add_argument('--finish-comments', action='store_true', help='output finish-comment')
|
||||
parser.add_argument('--no-finish-comments', action='store_true', help='suppress finish-comment output (default)')
|
||||
parser.add_argument('--path-comments', action='store_true', help='output path-comment')
|
||||
parser.add_argument('--no-path-comments', action='store_true', help='suppress path-comment output (default)')
|
||||
parser.add_argument('--header', action='store_true', help='output headers (default)')
|
||||
parser.add_argument('--no-header', action='store_true', help='suppress header output')
|
||||
parser.add_argument('--line-numbers', action='store_true', help='prefix with line numbers')
|
||||
parser.add_argument('--no-line-numbers', action='store_true', help='do not prefix with line numbers (default)')
|
||||
parser.add_argument('--show-editor', action='store_true', help='pop up editor before writing output (default)')
|
||||
parser.add_argument('--no-show-editor', action='store_true', help='do not pop up editor before writing output')
|
||||
parser.add_argument('--precision', default='3', help='number of digits of precision, default=3')
|
||||
parser.add_argument('--translate_drill', action='store_true', help='translate drill cycles G81, G82, and G83 in G0/G1 movements')
|
||||
parser.add_argument('--no-translate_drill', action='store_true', help='do not translate drill cycles G81, G82, and G83 in G0/G1 movements (default)')
|
||||
parser.add_argument('--preamble', help='set commands to be issued before the first command, default="G80\nG17\nG90"')
|
||||
parser.add_argument('--postamble', help='set commands to be issued after the last command, default="G80\nM5\nG17\nG90"')
|
||||
parser.add_argument('--inches', action='store_true', help='Convert output for US imperial mode (G20)')
|
||||
parser.add_argument('--tool-change', action='store_true', help='Insert M6 for all tool changes')
|
||||
parser.add_argument('--wait-for-spindle', type=int, default=0, help='Wait for spindle to reach desired speed after M3 / M4, default=0')
|
||||
parser.add_argument('--return-to', default='', help='Move to the specified coordinates at the end, e.g. --return-to=0,0')
|
||||
parser.add_argument('--bcnc', action='store_true', help='Add Job operations as bCNC block headers. Consider suppressing existing comments: Add argument --no-comments')
|
||||
parser.add_argument('--no-bcnc', action='store_true', help='suppress bCNC block header output (default)')
|
||||
TOOLTIP_ARGS = parser.format_help()
|
||||
|
||||
|
||||
# ***************************************************************************
|
||||
# * Internal global variables
|
||||
# ***************************************************************************
|
||||
MOTION_COMMANDS = ['G0', 'G00', 'G1', 'G01', 'G2', 'G02', 'G3', 'G03'] # Motion gcode commands definition
|
||||
RAPID_MOVES = ['G0', 'G00'] # Rapid moves gcode commands definition
|
||||
SUPPRESS_COMMANDS = ['M2'] # These commands are ignored by commenting them out
|
||||
COMMAND_SPACE = " "
|
||||
# Global variables storing current position
|
||||
CURRENT_X = 0
|
||||
CURRENT_Y = 0
|
||||
CURRENT_Z = 0
|
||||
|
||||
# ***************************************************************************
|
||||
# * to distinguish python built-in open function from the one declared below
|
||||
if open.__module__ in ['__builtin__', 'io']:
|
||||
pythonopen = open
|
||||
|
||||
|
||||
def processArguments(argstring):
|
||||
|
||||
global OUTPUT_HEADER
|
||||
global OUTPUT_COMMENTS
|
||||
global OUTPUT_FINISH
|
||||
global OUTPUT_PATH
|
||||
global OUTPUT_LINE_NUMBERS
|
||||
global SHOW_EDITOR
|
||||
global PRECISION
|
||||
global PREAMBLE
|
||||
global POSTAMBLE
|
||||
global UNITS
|
||||
global UNIT_SPEED_FORMAT
|
||||
global UNIT_FORMAT
|
||||
global TRANSLATE_DRILL_CYCLES
|
||||
global OUTPUT_TOOL_CHANGE
|
||||
global SPINDLE_WAIT
|
||||
global RETURN_TO
|
||||
global OUTPUT_BCNC
|
||||
|
||||
try:
|
||||
args = parser.parse_args(shlex.split(argstring))
|
||||
if args.no_header:
|
||||
OUTPUT_HEADER = False
|
||||
if args.header:
|
||||
OUTPUT_HEADER = True
|
||||
if args.no_comments:
|
||||
OUTPUT_COMMENTS = False
|
||||
if args.comments:
|
||||
OUTPUT_COMMENTS = True
|
||||
if args.no_finish_comments:
|
||||
OUTPUT_FINISH = False
|
||||
if args.finish_comments:
|
||||
OUTPUT_FINISH = True
|
||||
if args.no_path_comments:
|
||||
OUTPUT_PATH = False
|
||||
if args.path_comments:
|
||||
OUTPUT_PATH = True
|
||||
if args.no_line_numbers:
|
||||
OUTPUT_LINE_NUMBERS = False
|
||||
if args.line_numbers:
|
||||
OUTPUT_LINE_NUMBERS = True
|
||||
if args.no_show_editor:
|
||||
SHOW_EDITOR = False
|
||||
if args.show_editor:
|
||||
SHOW_EDITOR = True
|
||||
PRECISION = args.precision
|
||||
if args.preamble is not None:
|
||||
PREAMBLE = args.preamble
|
||||
if args.postamble is not None:
|
||||
POSTAMBLE = args.postamble
|
||||
if args.no_translate_drill:
|
||||
TRANSLATE_DRILL_CYCLES = False
|
||||
if args.translate_drill:
|
||||
TRANSLATE_DRILL_CYCLES = True
|
||||
if args.inches:
|
||||
UNITS = 'G20'
|
||||
UNIT_SPEED_FORMAT = 'in/min'
|
||||
UNIT_FORMAT = 'in'
|
||||
PRECISION = 4
|
||||
if args.tool_change:
|
||||
OUTPUT_TOOL_CHANGE = True
|
||||
if args.wait_for_spindle > 0:
|
||||
SPINDLE_WAIT = args.wait_for_spindle
|
||||
if args.return_to != '':
|
||||
RETURN_TO = [int(v) for v in args.return_to.split(',')]
|
||||
if len(RETURN_TO) != 2:
|
||||
RETURN_TO = None
|
||||
print("--return-to coordinates must be specified as <x>,<y>, ignoring")
|
||||
if args.bcnc:
|
||||
OUTPUT_BCNC = True
|
||||
if args.no_bcnc:
|
||||
OUTPUT_BCNC = False
|
||||
|
||||
|
||||
except Exception as e:
|
||||
return False
|
||||
|
||||
return True
|
||||
|
||||
|
||||
# For debug...
|
||||
def dump(obj):
|
||||
for attr in dir(obj):
|
||||
print("obj.%s = %s" % (attr, getattr(obj, attr)))
|
||||
|
||||
|
||||
def export(objectslist, filename, argstring):
|
||||
|
||||
if not processArguments(argstring):
|
||||
return None
|
||||
|
||||
global UNITS
|
||||
global UNIT_FORMAT
|
||||
global UNIT_SPEED_FORMAT
|
||||
global MOTION_MODE
|
||||
global SUPPRESS_COMMANDS
|
||||
|
||||
print("Post Processor: " + __name__ + " postprocessing...")
|
||||
gcode = ""
|
||||
|
||||
# write header
|
||||
if OUTPUT_HEADER:
|
||||
gcode += linenumber() + "(Exported by FreeCAD)\n"
|
||||
gcode += linenumber() + "(Post Processor: " + __name__ + ".py, version: " + Revised + ")\n"
|
||||
gcode += linenumber() + "(Output Time:" + str(datetime.datetime.now()) + ")\n"
|
||||
|
||||
# Check canned cycles for drilling
|
||||
if TRANSLATE_DRILL_CYCLES:
|
||||
if len(SUPPRESS_COMMANDS) == 0:
|
||||
SUPPRESS_COMMANDS = ['G98', 'G99', 'G80']
|
||||
else:
|
||||
SUPPRESS_COMMANDS += ['G98', 'G99', 'G80']
|
||||
|
||||
# Write the preamble
|
||||
if OUTPUT_COMMENTS:
|
||||
gcode += linenumber() + "(Begin preamble)\n"
|
||||
for line in PREAMBLE.splitlines(True):
|
||||
gcode += linenumber() + line
|
||||
# verify if PREAMBLE has changed MOTION_MODE or UNITS
|
||||
if 'G90' in PREAMBLE:
|
||||
MOTION_MODE = 'G90'
|
||||
elif 'G91' in PREAMBLE:
|
||||
MOTION_MODE = 'G91'
|
||||
else:
|
||||
gcode += linenumber() + MOTION_MODE + "\n"
|
||||
if 'G21' in PREAMBLE:
|
||||
UNITS = 'G21'
|
||||
UNIT_FORMAT = 'mm'
|
||||
UNIT_SPEED_FORMAT = 'mm/min'
|
||||
elif 'G20' in PREAMBLE:
|
||||
UNITS = 'G20'
|
||||
UNIT_FORMAT = 'in'
|
||||
UNIT_SPEED_FORMAT = 'in/min'
|
||||
else:
|
||||
gcode += linenumber() + UNITS + "\n"
|
||||
|
||||
for obj in objectslist:
|
||||
# Debug...
|
||||
# print("\n" + "*"*70)
|
||||
# dump(obj)
|
||||
# print("*"*70 + "\n")
|
||||
if not hasattr(obj, "Path"):
|
||||
print("The object " + obj.Name + " is not a path. Please select only path and Compounds.")
|
||||
return
|
||||
|
||||
# Skip inactive operations
|
||||
if PathUtil.opProperty(obj, 'Active') is False:
|
||||
continue
|
||||
|
||||
# do the pre_op
|
||||
if OUTPUT_BCNC:
|
||||
gcode += linenumber() + "(Block-name: " + obj.Label + ")\n"
|
||||
gcode += linenumber() + "(Block-expand: 0)\n"
|
||||
gcode += linenumber() + "(Block-enable: 1)\n"
|
||||
if OUTPUT_COMMENTS:
|
||||
gcode += linenumber() + "(Begin operation: " + obj.Label + ")\n"
|
||||
for line in PRE_OPERATION.splitlines(True):
|
||||
gcode += linenumber() + line
|
||||
|
||||
# get coolant mode
|
||||
coolantMode = 'None'
|
||||
if hasattr(obj, "CoolantMode") or hasattr(obj, 'Base') and hasattr(obj.Base, "CoolantMode"):
|
||||
if hasattr(obj, "CoolantMode"):
|
||||
coolantMode = obj.CoolantMode
|
||||
else:
|
||||
coolantMode = obj.Base.CoolantMode
|
||||
|
||||
# turn coolant on if required
|
||||
if OUTPUT_COMMENTS:
|
||||
if not coolantMode == 'None':
|
||||
gcode += linenumber() + '(Coolant On:' + coolantMode + ')\n'
|
||||
if coolantMode == 'Flood':
|
||||
gcode += linenumber() + 'M8' + '\n'
|
||||
if coolantMode == 'Mist':
|
||||
gcode += linenumber() + 'M7' + '\n'
|
||||
|
||||
# Parse the op
|
||||
gcode += parse(obj)
|
||||
|
||||
# do the post_op
|
||||
if OUTPUT_COMMENTS and OUTPUT_FINISH:
|
||||
gcode += linenumber() + "(Finish operation: " + obj.Label + ")\n"
|
||||
for line in POST_OPERATION.splitlines(True):
|
||||
gcode += linenumber() + line
|
||||
|
||||
# turn coolant off if required
|
||||
if not coolantMode == 'None':
|
||||
if OUTPUT_COMMENTS:
|
||||
gcode += linenumber() + '(Coolant Off:' + coolantMode + ')\n'
|
||||
gcode += linenumber() +'M9' + '\n'
|
||||
|
||||
# do the post_amble
|
||||
if OUTPUT_BCNC:
|
||||
gcode += linenumber() + "(Block-name: post_amble)\n"
|
||||
gcode += linenumber() + "(Block-expand: 0)\n"
|
||||
gcode += linenumber() + "(Block-enable: 1)\n"
|
||||
if OUTPUT_COMMENTS:
|
||||
gcode += linenumber() + "(Begin postamble)\n"
|
||||
for line in POSTAMBLE.splitlines(True):
|
||||
gcode += linenumber() + line
|
||||
|
||||
if RETURN_TO:
|
||||
gcode += linenumber() + "G0 X%s Y%s" % tuple(RETURN_TO)
|
||||
|
||||
# show the gcode result dialog:
|
||||
if FreeCAD.GuiUp and SHOW_EDITOR:
|
||||
dia = PostUtils.GCodeEditorDialog()
|
||||
dia.editor.setText(gcode)
|
||||
result = dia.exec_()
|
||||
if result:
|
||||
final = dia.editor.toPlainText()
|
||||
else:
|
||||
final = gcode
|
||||
else:
|
||||
final = gcode
|
||||
|
||||
print("Done postprocessing.")
|
||||
|
||||
# write the file
|
||||
try:
|
||||
gfile = pythonopen(filename, "w")
|
||||
gfile.write(final)
|
||||
except Exception as e:
|
||||
print('Error in writing the gcode file:\n', e.args)
|
||||
finally:
|
||||
gfile.close()
|
||||
|
||||
|
||||
def linenumber():
|
||||
global LINENR
|
||||
global LINEINCR
|
||||
if OUTPUT_LINE_NUMBERS:
|
||||
s = "N" + str(LINENR) + " "
|
||||
LINENR += LINEINCR
|
||||
return s
|
||||
return ""
|
||||
|
||||
|
||||
def format_outstring(strTbl):
|
||||
global COMMAND_SPACE
|
||||
# construct the line for the final output
|
||||
s = ""
|
||||
for w in strTbl:
|
||||
s += w + COMMAND_SPACE
|
||||
s = s.strip()
|
||||
return s
|
||||
|
||||
|
||||
def parse(pathobj):
|
||||
|
||||
global DRILL_RETRACT_MODE
|
||||
global MOTION_MODE
|
||||
global CURRENT_X
|
||||
global CURRENT_Y
|
||||
global CURRENT_Z
|
||||
|
||||
out = ""
|
||||
lastcommand = None
|
||||
precision_string = '.' + str(PRECISION) + 'f'
|
||||
|
||||
params = ['X', 'Y', 'Z', 'A', 'B', 'C', 'U', 'V', 'W', 'I', 'J', 'K', 'F', 'S', 'T', 'Q', 'R', 'L', 'P']
|
||||
|
||||
if hasattr(pathobj, "Group"): # We have a compound or project.
|
||||
if OUTPUT_COMMENTS:
|
||||
out += linenumber() + "(Compound: " + pathobj.Label + ")\n"
|
||||
for p in pathobj.Group:
|
||||
out += parse(p)
|
||||
return out
|
||||
|
||||
else: # parsing simple path
|
||||
if not hasattr(pathobj, "Path"): # groups might contain non-path things like stock.
|
||||
return out
|
||||
|
||||
if OUTPUT_COMMENTS and OUTPUT_PATH:
|
||||
out += linenumber() + "(Path: " + pathobj.Label + ")\n"
|
||||
|
||||
for c in pathobj.Path.Commands:
|
||||
outstring = []
|
||||
command = c.Name
|
||||
|
||||
outstring.append(command)
|
||||
|
||||
# if modal: only print the command if it is not the same as the last one
|
||||
if MODAL:
|
||||
if command == lastcommand:
|
||||
outstring.pop(0)
|
||||
|
||||
# Now add the remaining parameters in order
|
||||
for param in params:
|
||||
if param in c.Parameters:
|
||||
if param == 'F':
|
||||
if command not in RAPID_MOVES:
|
||||
speed = Units.Quantity(c.Parameters['F'], FreeCAD.Units.Velocity)
|
||||
if speed.getValueAs(UNIT_SPEED_FORMAT) > 0.0:
|
||||
outstring.append(param + format(float(speed.getValueAs(UNIT_SPEED_FORMAT)), precision_string))
|
||||
elif param in ['T', 'H', 'D', 'S', 'P', 'L']:
|
||||
outstring.append(param + str(c.Parameters[param]))
|
||||
elif param in ['A', 'B', 'C']:
|
||||
outstring.append(param + format(c.Parameters[param], precision_string))
|
||||
else: # [X, Y, Z, U, V, W, I, J, K, R, Q] (Conversion eventuelle mm/inches)
|
||||
pos = Units.Quantity(c.Parameters[param], FreeCAD.Units.Length)
|
||||
outstring.append(param + format(float(pos.getValueAs(UNIT_FORMAT)), precision_string))
|
||||
|
||||
# store the latest command
|
||||
lastcommand = command
|
||||
|
||||
# Memorizes the current position for calculating the related movements and the withdrawal plan
|
||||
if command in MOTION_COMMANDS:
|
||||
if 'X' in c.Parameters:
|
||||
CURRENT_X = Units.Quantity(c.Parameters['X'], FreeCAD.Units.Length)
|
||||
if 'Y' in c.Parameters:
|
||||
CURRENT_Y = Units.Quantity(c.Parameters['Y'], FreeCAD.Units.Length)
|
||||
if 'Z' in c.Parameters:
|
||||
CURRENT_Z = Units.Quantity(c.Parameters['Z'], FreeCAD.Units.Length)
|
||||
|
||||
if command in ('G98', 'G99'):
|
||||
DRILL_RETRACT_MODE = command
|
||||
|
||||
if command in ('G90', 'G91'):
|
||||
MOTION_MODE = command
|
||||
|
||||
if TRANSLATE_DRILL_CYCLES:
|
||||
if command in ('G81', 'G82', 'G83'):
|
||||
out += drill_translate(outstring, command, c.Parameters)
|
||||
# Erase the line we just translated
|
||||
del(outstring[:])
|
||||
outstring = []
|
||||
|
||||
if SPINDLE_WAIT > 0:
|
||||
if command in ('M3', 'M03', 'M4', 'M04'):
|
||||
out += linenumber() + format_outstring(outstring) + "\n"
|
||||
out += linenumber() + format_outstring(['G4', 'P%s' % SPINDLE_WAIT]) + "\n"
|
||||
del(outstring[:])
|
||||
outstring = []
|
||||
|
||||
# Check for Tool Change:
|
||||
if command in ('M6', 'M06'):
|
||||
if OUTPUT_COMMENTS:
|
||||
out += linenumber() + "(Begin toolchange)\n"
|
||||
if not OUTPUT_TOOL_CHANGE:
|
||||
outstring[0] = "(" + outstring[0]
|
||||
outstring[-1] = outstring[-1] + ")"
|
||||
else:
|
||||
for line in TOOL_CHANGE.splitlines(True):
|
||||
out += linenumber() + line
|
||||
|
||||
if command == "message":
|
||||
if OUTPUT_COMMENTS is False:
|
||||
out = []
|
||||
else:
|
||||
outstring.pop(0) # remove the command
|
||||
|
||||
if command in SUPPRESS_COMMANDS:
|
||||
outstring[0] = "(" + outstring[0]
|
||||
outstring[-1] = outstring[-1] + ")"
|
||||
|
||||
# Prepend a line number and append a newline
|
||||
if len(outstring) >= 1:
|
||||
out += linenumber() + format_outstring(outstring) + "\n"
|
||||
|
||||
return out
|
||||
|
||||
def drill_translate(outstring, cmd, params):
|
||||
''' As of Marlin 2.0.7.bugfix, canned drill cycles do not exist.
|
||||
The following code converts FreeCAD's canned drill cycles into
|
||||
gcode that Marlin can use.
|
||||
'''
|
||||
global DRILL_RETRACT_MODE
|
||||
global MOTION_MODE
|
||||
global CURRENT_X
|
||||
global CURRENT_Y
|
||||
global CURRENT_Z
|
||||
global UNITS
|
||||
global UNIT_FORMAT
|
||||
global UNIT_SPEED_FORMAT
|
||||
|
||||
strFormat = '.' + str(PRECISION) + 'f'
|
||||
|
||||
trBuff = ""
|
||||
|
||||
if OUTPUT_COMMENTS: # Comment the original command
|
||||
outstring[0] = "(" + outstring[0]
|
||||
outstring[-1] = outstring[-1] + ")"
|
||||
trBuff += linenumber() + format_outstring(outstring) + "\n"
|
||||
|
||||
# Cycle conversion
|
||||
# Only converts the cycles in the XY plane (G17).
|
||||
# ZX (G18) and YZ (G19) planes are not processed: Calculations on Z only.
|
||||
if MOTION_MODE == 'G90': # absolute positions:
|
||||
drill_X = Units.Quantity(params['X'], FreeCAD.Units.Length)
|
||||
drill_Y = Units.Quantity(params['Y'], FreeCAD.Units.Length)
|
||||
drill_Z = Units.Quantity(params['Z'], FreeCAD.Units.Length)
|
||||
RETRACT_Z = Units.Quantity(params['R'], FreeCAD.Units.Length)
|
||||
else: # G91 relative positions:
|
||||
drill_X = CURRENT_X + Units.Quantity(params['X'], FreeCAD.Units.Length)
|
||||
drill_Y = CURRENT_Y + Units.Quantity(params['Y'], FreeCAD.Units.Length)
|
||||
drill_Z = CURRENT_Z + Units.Quantity(params['Z'], FreeCAD.Units.Length)
|
||||
RETRACT_Z = CURRENT_Z + Units.Quantity(params['R'], FreeCAD.Units.Length)
|
||||
|
||||
# Get the values for various parameters:
|
||||
drill_Speed = Units.Quantity(params['F'], FreeCAD.Units.Velocity)
|
||||
if cmd == 'G83':
|
||||
drill_Step = Units.Quantity(params['Q'], FreeCAD.Units.Length)
|
||||
elif cmd == 'G82':
|
||||
drill_DwellTime = params['P']
|
||||
|
||||
if MOTION_MODE == 'G91':
|
||||
# Use absolute coordinates during the drill cycle:
|
||||
trBuff += linenumber() + "G90" + "\n"
|
||||
|
||||
# For G83, retract to Z_Rvalue after each peck:
|
||||
Z_Rvalue = RETRACT_Z # RETRACT_Z might get changed below.
|
||||
|
||||
# Z height to retract to when drill cycle is done:
|
||||
if DRILL_RETRACT_MODE == 'G98' and CURRENT_Z >= RETRACT_Z:
|
||||
RETRACT_Z = CURRENT_Z
|
||||
|
||||
# Preliminary movements:
|
||||
trBuff += linenumber() + 'G0 X' + format(float(drill_X.getValueAs(UNIT_FORMAT)), strFormat) + ' Y' + format(float(drill_Y.getValueAs(UNIT_FORMAT)), strFormat) + "\n"
|
||||
|
||||
if CURRENT_Z < RETRACT_Z:
|
||||
trBuff += linenumber() + 'G0 Z' + format(float(RETRACT_Z.getValueAs(UNIT_FORMAT)), strFormat) + "\n"
|
||||
else:
|
||||
trBuff += linenumber() + 'G0 Z' + format(float(CURRENT_Z.getValueAs(UNIT_FORMAT)), strFormat) + "\n"
|
||||
|
||||
""" Drill cycles:
|
||||
G80 Cancel the drill cycle.
|
||||
G81 Drill full depth in one pass.
|
||||
G82 Drill full depth in one pass, and pause at the bottom.
|
||||
G83 Drill in small pecks (steps), raising the drill to R height after each peck.
|
||||
G98 After the hole has been drilled, retract to the initial Z height (clearance height).
|
||||
G99 After the hole has been drilled, retract to R height.
|
||||
"""
|
||||
if cmd in ('G81', 'G82'):
|
||||
trBuff += linenumber() + 'G1 Z' + format(float(drill_Z.getValueAs(UNIT_FORMAT)), strFormat) + ' F' + format(float(drill_Speed.getValueAs(UNIT_SPEED_FORMAT)), '.2f') + "\n"
|
||||
# G82 uses a dwell time delay:
|
||||
if cmd == 'G82':
|
||||
trBuff += linenumber() + 'G4 P' + str(drill_DwellTime) + "\n"
|
||||
# Retract the drill:
|
||||
trBuff += linenumber() + 'G0 Z' + format(float(RETRACT_Z.getValueAs(UNIT_FORMAT)), strFormat) + "\n"
|
||||
else: # G83 Peck drill cycle:
|
||||
next_Stop_Z = Z_Rvalue - drill_Step
|
||||
while next_Stop_Z >= drill_Z:
|
||||
# Drill one peck depth:
|
||||
trBuff += linenumber() + 'G1 Z' + format(float(next_Stop_Z.getValueAs(UNIT_FORMAT)), strFormat) + ' F' + format(float(drill_Speed.getValueAs(UNIT_SPEED_FORMAT)), '.2f') + "\n"
|
||||
# Rapid up to clear chips:
|
||||
trBuff += linenumber() + 'G0 Z' + format(float(Z_Rvalue.getValueAs(UNIT_FORMAT)), strFormat) + "\n"
|
||||
# Rapid down to just above the last peck depth:
|
||||
rapidDownZ = next_Stop_Z + (drill_Step * 0.5)
|
||||
trBuff += linenumber() + 'G0 Z' + format(float(rapidDownZ.getValueAs(UNIT_FORMAT)), strFormat) + "\n"
|
||||
|
||||
# Set the next depth:
|
||||
if (next_Stop_Z - drill_Step) >= drill_Z:
|
||||
next_Stop_Z -= drill_Step
|
||||
elif next_Stop_Z == drill_Z:
|
||||
break # Done
|
||||
else:
|
||||
trBuff += linenumber() + 'G1 Z' + format(float(drill_Z.getValueAs(UNIT_FORMAT)), strFormat) + ' F' + format(float(drill_Speed.getValueAs(UNIT_SPEED_FORMAT)), '.2f') + "\n"
|
||||
break # Done
|
||||
# Retract the drill:
|
||||
trBuff += linenumber() + 'G0 Z' + format(float(RETRACT_Z.getValueAs(UNIT_FORMAT)), strFormat) + "\n"
|
||||
|
||||
if MOTION_MODE == 'G91':
|
||||
trBuff += linenumber() + 'G91' # Restore relative positioning mode
|
||||
|
||||
return trBuff
|
||||
|
||||
|
||||
print(__name__ + ": GCode postprocessor loaded.")
|
||||
Reference in New Issue
Block a user