256 lines
8.7 KiB
Python
256 lines
8.7 KiB
Python
from FlatCAMPostProc import *
|
|
|
|
|
|
class Toolchange_Probe_MACH3(FlatCAMPostProc):
|
|
|
|
coordinate_format = "%.*f"
|
|
feedrate_format = '%.*f'
|
|
|
|
def start_code(self, p):
|
|
units = ' ' + str(p['units']).lower()
|
|
coords_xy = p['toolchange_xy']
|
|
gcode = ''
|
|
|
|
xmin = '%.*f' % (p.coords_decimals, p['options']['xmin'])
|
|
xmax = '%.*f' % (p.coords_decimals, p['options']['xmax'])
|
|
ymin = '%.*f' % (p.coords_decimals, p['options']['ymin'])
|
|
ymax = '%.*f' % (p.coords_decimals, p['options']['ymax'])
|
|
|
|
if str(p['options']['type']) == 'Geometry':
|
|
gcode += '(TOOL DIAMETER: ' + str(p['options']['tool_dia']) + units + ')\n'
|
|
|
|
gcode += '(Feedrate: ' + str(p['feedrate']) + units + '/min' + ')\n'
|
|
|
|
if str(p['options']['type']) == 'Geometry':
|
|
gcode += '(Feedrate_Z: ' + str(p['feedrate_z']) + units + '/min' + ')\n'
|
|
|
|
gcode += '(Feedrate rapids ' + str(p['feedrate_rapid']) + units + '/min' + ')\n' + '\n'
|
|
gcode += '(Z_Cut: ' + str(p['z_cut']) + units + ')\n'
|
|
|
|
if str(p['options']['type']) == 'Geometry':
|
|
if p['multidepth'] is True:
|
|
gcode += '(DepthPerCut: ' + str(p['depthpercut']) + units + ' <=>' + \
|
|
str(math.ceil(abs(p['z_cut']) / p['depthpercut'])) + ' passes' + ')\n'
|
|
|
|
gcode += '(Z_Move: ' + str(p['z_move']) + units + ')\n'
|
|
gcode += '(Z Toolchange: ' + str(p['toolchangez']) + units + ')\n'
|
|
|
|
if coords_xy is not None:
|
|
gcode += '(X,Y Toolchange: ' + "%.4f, %.4f" % (coords_xy[0], coords_xy[1]) + units + ')\n'
|
|
else:
|
|
gcode += '(X,Y Toolchange: ' + "None" + units + ')\n'
|
|
|
|
gcode += '(Z Start: ' + str(p['startz']) + units + ')\n'
|
|
gcode += '(Z End: ' + str(p['endz']) + units + ')\n'
|
|
gcode += '(Steps per circle: ' + str(p['steps_per_circle']) + ')\n'
|
|
|
|
if str(p['options']['type']) == 'Excellon' or str(p['options']['type']) == 'Excellon Geometry':
|
|
gcode += '(Postprocessor Excellon: ' + str(p['pp_excellon_name']) + ')\n'
|
|
else:
|
|
gcode += '(Postprocessor Geometry: ' + str(p['pp_geometry_name']) + ')\n' + '\n'
|
|
|
|
gcode += '(X range: ' + '{: >9s}'.format(xmin) + ' ... ' + '{: >9s}'.format(xmax) + ' ' + units + ')\n'
|
|
gcode += '(Y range: ' + '{: >9s}'.format(ymin) + ' ... ' + '{: >9s}'.format(ymax) + ' ' + units + ')\n\n'
|
|
|
|
gcode += '(Spindle Speed: %s RPM)\n' % str(p['spindlespeed'])
|
|
|
|
gcode += ('G20\n' if p.units.upper() == 'IN' else 'G21\n')
|
|
gcode += 'G90\n'
|
|
gcode += 'G17\n'
|
|
gcode += 'G94\n'
|
|
|
|
return gcode
|
|
|
|
def startz_code(self, p):
|
|
return ''
|
|
|
|
def lift_code(self, p):
|
|
return 'G00 Z' + self.coordinate_format%(p.coords_decimals, p.z_move)
|
|
|
|
def down_code(self, p):
|
|
return 'G01 Z' + self.coordinate_format%(p.coords_decimals, p.z_cut)
|
|
|
|
def toolchange_code(self, p):
|
|
toolchangez = p.toolchangez
|
|
toolchangexy = p.toolchange_xy
|
|
f_plunge = p.f_plunge
|
|
gcode = ''
|
|
|
|
if toolchangexy is not None:
|
|
toolchangex = toolchangexy[0]
|
|
toolchangey = toolchangexy[1]
|
|
|
|
no_drills = 1
|
|
|
|
if int(p.tool) == 1 and p.startz is not None:
|
|
toolchangez = p.startz
|
|
|
|
if p.units.upper() == 'MM':
|
|
toolC_formatted = format(p.toolC, '.2f')
|
|
else:
|
|
toolC_formatted = format(p.toolC, '.4f')
|
|
|
|
if str(p['options']['type']) == 'Excellon':
|
|
for i in p['options']['Tools_in_use']:
|
|
if i[0] == p.tool:
|
|
no_drills = i[2]
|
|
|
|
if toolchangexy is not None:
|
|
gcode = """
|
|
T{tool}
|
|
M5
|
|
G00 Z{toolchangez}
|
|
G00 X{toolchangex} Y{toolchangey}
|
|
(MSG, Change to Tool Dia = {toolC} ||| Drills for this tool = {t_drills} ||| Tool Probing MACH3)
|
|
M0
|
|
G00 Z{z_move}
|
|
F{fr}
|
|
G31 Z{z_pdepth}
|
|
G92 Z0
|
|
G00 Z{z_move}
|
|
F{fr_slow}
|
|
G31 Z{z_pdepth}
|
|
G92 Z0
|
|
(MSG, Remove any clips or other devices used for probing. CNC work is resuming ...)
|
|
M0
|
|
G00 Z{z_move}
|
|
""".format(toolchangex=self.coordinate_format % (p.coords_decimals, toolchangex),
|
|
toolchangey=self.coordinate_format % (p.coords_decimals, toolchangey),
|
|
toolchangez=self.coordinate_format % (p.coords_decimals, toolchangez),
|
|
z_move=self.coordinate_format % (p.coords_decimals, p.z_move),
|
|
fr=str(self.feedrate_format %(p.fr_decimals, p.feedrate)),
|
|
fr_slow=str(self.feedrate_format % (p.fr_decimals, (p.feedrate / 2))),
|
|
z_pdepth=self.coordinate_format % (p.coords_decimals, p.z_pdepth),
|
|
tool=int(p.tool),
|
|
t_drills=no_drills,
|
|
toolC=toolC_formatted)
|
|
else:
|
|
gcode = """
|
|
T{tool}
|
|
M5
|
|
G00 Z{toolchangez}
|
|
(MSG, Change to Tool Dia = {toolC} ||| Drills for this tool = {t_drills} ||| Tool Probing MACH3)
|
|
M0
|
|
G00 Z{z_move}
|
|
F{fr}
|
|
G31 Z{z_pdepth}
|
|
G92 Z0
|
|
G00 Z{z_move}
|
|
F{fr_slow}
|
|
G31 Z{z_pdepth}
|
|
G92 Z0
|
|
(MSG, Remove any clips or other devices used for probing. CNC work is resuming ...)
|
|
M0
|
|
G00 Z{z_move}
|
|
""".format(toolchangez=self.coordinate_format % (p.coords_decimals, toolchangez),
|
|
z_move=self.coordinate_format % (p.coords_decimals, p.z_move),
|
|
fr=str(self.feedrate_format %(p.fr_decimals, p.feedrate)),
|
|
fr_slow=str(self.feedrate_format % (p.fr_decimals, (p.feedrate / 2))),
|
|
z_pdepth=self.coordinate_format % (p.coords_decimals, p.z_pdepth),
|
|
tool=int(p.tool),
|
|
t_drills=no_drills,
|
|
toolC=toolC_formatted)
|
|
|
|
# if f_plunge is True:
|
|
# gcode += '\nG00 Z%.*f' % (p.coords_decimals, p.z_move)
|
|
return gcode
|
|
|
|
else:
|
|
if toolchangexy is not None:
|
|
gcode = """
|
|
T{tool}
|
|
M5
|
|
G00 Z{toolchangez}
|
|
G00 X{toolchangex} Y{toolchangey}
|
|
(MSG, Change to Tool Dia = {toolC} ||| Tool Probing MACH3)
|
|
M0
|
|
G00 Z{z_move}
|
|
F{fr}
|
|
G31 Z{z_pdepth}
|
|
G92 Z0
|
|
G00 Z{z_move}
|
|
F{fr_slow}
|
|
G31 Z{z_pdepth}
|
|
G92 Z0
|
|
(MSG, Remove any clips or other devices used for probing. CNC work is resuming ...)
|
|
M0
|
|
G00 Z{z_move}
|
|
""".format(toolchangex=self.coordinate_format % (p.coords_decimals, toolchangex),
|
|
toolchangey=self.coordinate_format % (p.coords_decimals, toolchangey),
|
|
toolchangez=self.coordinate_format % (p.coords_decimals, toolchangez),
|
|
z_move=self.coordinate_format % (p.coords_decimals, p.z_move),
|
|
fr=str(self.feedrate_format % (p.fr_decimals, p.feedrate)),
|
|
fr_slow=str(self.feedrate_format % (p.fr_decimals, (p.feedrate / 2))),
|
|
z_pdepth=self.coordinate_format % (p.coords_decimals, p.z_pdepth),
|
|
tool=int(p.tool),
|
|
toolC=toolC_formatted)
|
|
else:
|
|
gcode = """
|
|
T{tool}
|
|
M5
|
|
G00 Z{toolchangez}
|
|
(MSG, Change to Tool Dia = {toolC} ||| Tool Probing MACH3)
|
|
M0
|
|
G00 Z{z_move}
|
|
F{fr}
|
|
G31 Z{z_pdepth}
|
|
G92 Z0
|
|
G00 Z{z_move}
|
|
F{fr_slow}
|
|
G31 Z{z_pdepth}
|
|
G92 Z0
|
|
(MSG, Remove any clips or other devices used for probing. CNC work is resuming ...)
|
|
M0
|
|
G00 Z{z_move}
|
|
""".format(toolchangez=self.coordinate_format % (p.coords_decimals, toolchangez),
|
|
z_move=self.coordinate_format % (p.coords_decimals, p.z_move),
|
|
fr=str(self.feedrate_format %(p.fr_decimals, p.feedrate)),
|
|
fr_slow=str(self.feedrate_format % (p.fr_decimals, (p.feedrate / 2))),
|
|
z_pdepth=self.coordinate_format % (p.coords_decimals, p.z_pdepth),
|
|
tool=int(p.tool),
|
|
toolC=toolC_formatted)
|
|
|
|
# if f_plunge is True:
|
|
# gcode += '\nG00 Z%.*f' % (p.coords_decimals, p.z_move)
|
|
return gcode
|
|
|
|
def up_to_zero_code(self, p):
|
|
return 'G01 Z0'
|
|
|
|
def position_code(self, p):
|
|
return ('X' + self.coordinate_format + ' Y' + self.coordinate_format) % \
|
|
(p.coords_decimals, p.x, p.coords_decimals, p.y)
|
|
|
|
def rapid_code(self, p):
|
|
return ('G00 ' + self.position_code(p)).format(**p)
|
|
|
|
def linear_code(self, p):
|
|
return ('G01 ' + self.position_code(p)).format(**p)
|
|
|
|
def end_code(self, p):
|
|
coords_xy = p['toolchange_xy']
|
|
gcode = ('G00 Z' + self.feedrate_format %(p.fr_decimals, p.endz) + "\n")
|
|
|
|
if coords_xy is not None:
|
|
gcode += 'G00 X{x} Y{y}'.format(x=coords_xy[0], y=coords_xy[1]) + "\n"
|
|
return gcode
|
|
|
|
def feedrate_code(self, p):
|
|
return 'G01 F' + str(self.feedrate_format %(p.fr_decimals, p.feedrate))
|
|
|
|
def feedrate_z_code(self, p):
|
|
return 'G01 F' + str(self.feedrate_format %(p.fr_decimals, p.feedrate_z))
|
|
|
|
def spindle_code(self, p):
|
|
if p.spindlespeed:
|
|
return 'M03 S' + str(p.spindlespeed)
|
|
else:
|
|
return 'M03'
|
|
|
|
def dwell_code(self, p):
|
|
if p.dwelltime:
|
|
return 'G4 P' + str(p.dwelltime)
|
|
|
|
def spindle_stop_code(self,p):
|
|
return 'M05'
|