added tool touch off subroutine and parameters entries to probe basic

Author: Lcvette

config/atc_sim/macros_sim_inch/tool_touch_off.ngc

@@ -0,0 +1,52 @@
+o<tool_touch_off> sub
+
+#<fast_probe_fr> = #1       (set from probe screen fast probe feed rate)
+#<slow_probe_fr> = #2       (set from probe screen slow probe feedrate)
+#<z_max_travel> = #3             (max z distance the tool travels before erroring out if not contact is made)
+#<xy_max_travel> = #4            (max xy distance the tool travels before erroring out if not contact is made)
+#<retract_distance> = #6         (distance the tool retracts after making contact during fast feed mode)
+#<spindle_zero_height> = #5	     (G53 distance from home to spindle nose triggering point on touch plate)
+#<tool_diameter_probe_mode> = #8 (activates the tool diameter probe subroutine section)
+
+G92.1    (Cancel G92 offset)
+
+#<workspace_z> = #[5203 + [20 * #5220]]
+
+G49    (cancel tlo)
+
+G53 G0 Z0
+G30
+
+G91
+F #<fast_probe_fr>
+G38.2 Z-[#<z_max_travel>]    (fast probe)
+#<z_fast_probe> = #5063
+G0 Z[#<retract_distance>]
+
+F #<slow_probe_fr>
+G38.2 Z-[#<retract_distance> * 2]    (slow probe)
+
+o110 if [#5070]    (probing succesful)
+  #<z_slow_probe> = #5063    (save result)
+o110 else
+  (print,Tool Length Offset Probe Failed)
+o110 endif
+
+G0 Z[#<retract_distance>]
+
+(Tool Diameter Probe Mode Section, User must define this section as needed)
+o<120> if [#<tool_diameter_probe_mode> EQ 1]
+  (print, Tool Diameter Probing is Not Defined in Subroutine)
+o<120> endif
+
+G90
+G53 G0 Z0 (Send Spindle to home zero position)
+
+#<new_tool_length_offset> = [ABS[#<spindle_zero_height> + #<z_slow_probe>]]
+
+G10 L1 P #5400 Z [#<new_tool_length_offset>]  (5400 = tool number)
+G43  (enable tool length offset)
+
+o<tool_touch_off> endsub
+
+M2 (end program)

config/atc_sim/macros_sim_metric/tool_touch_off.ngc

@@ -0,0 +1,52 @@
+o<tool_touch_off> sub
+
+#<fast_probe_fr> = #1       (set from probe screen fast probe feed rate)
+#<slow_probe_fr> = #2       (set from probe screen slow probe feedrate)
+#<z_max_travel> = #3             (max z distance the tool travels before erroring out if not contact is made)
+#<xy_max_travel> = #4            (max xy distance the tool travels before erroring out if not contact is made)
+#<retract_distance> = #6         (distance the tool retracts after making contact during fast feed mode)
+#<spindle_zero_height> = #5	     (G53 distance from home to spindle nose triggering point on touch plate)
+#<tool_diameter_probe_mode> = #8 (activates the tool diameter probe subroutine section)
+
+G92.1    (Cancel G92 offset)
+
+#<workspace_z> = #[5203 + [20 * #5220]]
+
+G49    (cancel tlo)
+
+G53 G0 Z0
+G30
+
+G91
+F #<fast_probe_fr>
+G38.2 Z-[#<z_max_travel>]    (fast probe)
+#<z_fast_probe> = #5063
+G0 Z[#<retract_distance>]
+
+F #<slow_probe_fr>
+G38.2 Z-[#<retract_distance> * 2]    (slow probe)
+
+o110 if [#5070]    (probing succesful)
+  #<z_slow_probe> = #5063    (save result)
+o110 else
+  (print,Tool Length Offset Probe Failed)
+o110 endif
+
+G0 Z[#<retract_distance>]
+
+(Tool Diameter Probe Mode Section, User must define this section as needed)
+o<120> if [#<tool_diameter_probe_mode> EQ 1]
+  (print, Tool Diameter Probing is Not Defined in Subroutine)
+o<120> endif
+
+G90
+G53 G0 Z0 (Send Spindle to home zero position)
+
+#<new_tool_length_offset> = [ABS[#<spindle_zero_height> + #<z_slow_probe>]]
+
+G10 L1 P #5400 Z [#<new_tool_length_offset>]  (5400 = tool number)
+G43  (enable tool length offset)
+
+o<tool_touch_off> endsub
+
+M2 (end program)

config/probe_basic/subroutines/tool_touch_off.ngc

@@ -1,73 +1,52 @@
-
 o<tool_touch_off> sub
-;(debug, in change tool_in_spindle=#<tool_in_spindle> my_current_pocket=#<my_current_pocket>)
-;(debug, selected_tool=#<selected_tool> selected_pocket=#<selected_pocket>)
 
-;otherwise after the M6 this information is gone!
-#<tool> = #<selected_tool>
-#<pocket> = #<selected_pocket>
+#<fast_probe_fr> = #1       (set from probe screen fast probe feed rate)
+#<slow_probe_fr> = #2       (set from probe screen slow probe feedrate)
+#<z_max_travel> = #3             (max z distance the tool travels before erroring out if not contact is made)
+#<xy_max_travel> = #4            (max xy distance the tool travels before erroring out if not contact is made)
+#<retract_distance> = #6         (distance the tool retracts after making contact during fast feed mode)
+#<spindle_zero_height> = #5	     (G53 distance from home to spindle nose triggering point on touch plate)
+#<tool_diameter_probe_mode> = #8 (activates the tool diameter probe subroutine section)
 
-; we must execute this only in the milltask interpreter
-; or preview will break, so test for '#<_task>' which is 1 for
-; the milltask interpreter and 0 in the UI's
-O100 if [#<_task> EQ 0]
-        (debug, Task ist Null)
-O100     return [999]
-O100 endif
+G92.1    (Cancel G92 offset)
 
-;first go up
-G53 G0 Z0
-; then move to change position
-G30
+#<workspace_z> = #[5203 + [20 * #5220]]
 
-; cancel tool offset
-G49
+G49    (cancel tlo)
 
-; using the code being remapped here means 'use builtin behaviour'
-M6
-
-O200 if [#<_hal[gmoccapy.toolmeasurement]> EQ 0]
-O200 return [3] ; indicate no tool measurement
-O200 endif
+G53 G0 Z0
+G30
 
-G53 G0 X[#<_ini[TOOLSENSOR]X>] Y[#<_ini[TOOLSENSOR]Y>]
-G53 G0 Z[#<_ini[TOOLSENSOR]Z>]
+G91
+F #<fast_probe_fr>
+G38.2 Z-[#<z_max_travel>]    (fast probe)
+#<z_fast_probe> = #5063
+G0 Z[#<retract_distance>]
 
-O300 if [#<_hal[gmoccapy.searchvel]> LE 0]
-O300 return [-1] ; indicate searchvel <= 0
-O300 endif
+F #<slow_probe_fr>
+G38.2 Z-[#<retract_distance> * 2]    (slow probe)
 
-O400 if [#<_hal[gmoccapy.probevel]> LE 0]
-O400 return [-2] ; indicate probevel <= 0
-O400 endif
+o110 if [#5070]    (probing succesful)
+  #<z_slow_probe> = #5063    (save result)
+o110 else
+  (print,Tool Length Offset Probe Failed)
+o110 endif
 
-F #<_hal[gmoccapy.searchvel]>
-G91
-G38.2 Z #<_ini[TOOLSENSOR]MAXPROBE>
-G0 Z2
-; This is commented out only for sim.
-;F #<_hal[gmoccapy.probevel]>
-;G38.2 Z-4
+G0 Z[#<retract_distance>]
 
-O500 if [#5070 EQ 0]
-G90
-O500 return [-3] ; indicate probe contact failure to epilog
-O500 endif
+(Tool Diameter Probe Mode Section, User must define this section as needed)
+o<120> if [#<tool_diameter_probe_mode> EQ 1]
+  (print, Tool Diameter Probing is Not Defined in Subroutine)
+o<120> endif
 
 G90
-G53 G0 Z[#<_ini[CHANGE_POSITION]Z>]
-
-#<touch_result> = #5063
-#<probeheight> = #<_hal[gmoccapy.probeheight]>
-#<blockheight> = #<_hal[gmoccapy.blockheight]>
+G53 G0 Z0 (Send Spindle to home zero position)
 
-;(DEBUG, #<touch_result>  #<probeheight>  #<blockheight>)
+#<new_tool_length_offset> = [ABS[#<spindle_zero_height> + #<z_slow_probe>]]
 
-G10 L1 P#<tool> Z[#<touch_result> - #<_hal[gmoccapy.probeheight]> + #<_hal[gmoccapy.blockheight]>]
-G43
+G10 L1 P #5400 Z [#<new_tool_length_offset>]  (5400 = tool number)
+G43  (enable tool length offset)
 
-;G10 L1 P#<tool> Z#<touch_result>
-;G10 L2 P0 Z[#<workpieceheight> + #<probeheight> + #<touch_result>]
+o<tool_touch_off> endsub
 
-; signal success be returning a value > 0:
-o<tool_touch_off> endsub [1]
+M2 (end program)

config/probe_basic/tool.tbl

@@ -1,4 +1,3 @@
-;Tool  Pocket X Offset Y Offset Z Offset Diameter Remark
-T1     P1     X0.0     Y0.0     Z2.5     D0.25    ; test tool 1
-T2     P2     X0.0     Y0.0     Z1.5     D0.375   ; test tool 2
-T99    P3     X0.0     Y0.0     Z1.0     D0.125   ; TOUCH probe
+T1 P1 D0.250000 ; test tool 1
+T2 P2 D0.375000 Z+6.902098 ; test tool 2
+T99 P3 D0.125000 Z+1.000000 ; TOUCH probe