dodalem probe basic

configs/atc_sim/macros_sim/tool_touch_off.ngc

@@ -0,0 +1,101 @@
+(author: Chris P, TooTall18)
+(version: 0.2)
+(date: 06/27/24)
+
+o<tool_touch_off> sub
+
+#<fast_probe_fr> = #3004    (set from probe screen fast probe feed rate)
+#<slow_probe_fr> = #3005    (set from probe screen slow probe feedrate)
+#<traverse_fr> = #3006    (set from probe screen traverse probe feedrate)
+#<z_max_travel> = #3007    (max z distance the tool travels before erroring out if not contact is made)
+#<xy_max_travel> = #3008    (max xy distance the tool travels before erroring out if not contact is made)
+#<retract_distance> = #3009    (distance the tool retracts after making contact during fast feed mode)
+#<spindle_zero_height> = #3010    (G53 distance from home to spindle nose triggering point on touch plate)
+#<tool_diameter_probe_mode> = #3011    (activates the tool diameter probe subroutine section)
+#<tool_diameter_offset_mode> = #3012    (activates the tool diameter offset position for probe subroutine section)
+#<tool_setter_offset_direction> = #3013    (sets tool setter offset direction to move tool)
+#<tool_diameter> = #5410    (current tool's diameter used for offseting probe position in x axis)
+
+G92.1    (Cancel G92 offset)
+M50 P0
+
+#<tool_touch_x_coords> = #5181
+#<tool_touch_y_coords> = #5182
+#<tool_touch_z_coords> = #5183
+
+#<tool_radius_offset> = [#<tool_diameter> / 2]
+#<left_offset_probing_position> = [#<tool_touch_x_coords> - #<tool_radius_offset>]
+#<right_offset_probing_position> = [#<tool_touch_x_coords> + #<tool_radius_offset>]
+#<front_offset_probing_position> = [#<tool_touch_y_coords> - #<tool_radius_offset>]
+#<back_offset_probing_position> = [#<tool_touch_y_coords> + #<tool_radius_offset>]
+
+o100 if [#<tool_diameter_offset_mode> EQ 1]
+    o101 if [#<tool_setter_offset_direction> EQ 0]
+        #<tool_touch_x_coords> = #<left_offset_probing_position>
+    o101 else if [#<tool_setter_offset_direction> EQ 1]
+        #<tool_touch_x_coords> = #<right_offset_probing_position>
+    o101 else if [#<tool_setter_offset_direction> EQ 2]
+        #<tool_touch_y_coords> = #<front_offset_probing_position>
+    o101 else if [#<tool_setter_offset_direction> EQ 3]
+        #<tool_touch_y_coords> = #<back_offset_probing_position>
+    o101 endif
+o100 endif
+
+o110 if [2 EQ 2]
+    G49
+o110 endif
+
+G90    (set absolute coordinates)
+G53 G1 F[#<traverse_fr>] Z0    (move to z0 home position)
+G53 G1 F[#<traverse_fr>] X#<tool_touch_x_coords> Y#<tool_touch_y_coords>
+G53 G1 F[#<traverse_fr>] Z#<tool_touch_z_coords>
+
+#<offset_z> = #5422         ;Stores the offset of the current Z coordinate.
+
+G91
+F #<fast_probe_fr>
+G38.2 Z-[#<z_max_travel>]    (fast tool probe)
+#<z_fast_probe> = #5063    (save probe result of fast probe to parameters)
+G1 F[#<traverse_fr>] Z[#<retract_distance>]    (retract tool retract distance amount)
+
+(Slow Probe Rule, if Slow Probe FR is set to 0, Slow Probe is Bypassed)
+o120 if [#<slow_probe_fr> GT 0]
+    (Initiate Slow Z- Probe)
+    G91
+    F[#<slow_probe_fr>]    (set probe slow feedrate)
+    G38.2 Z-[#<retract_distance> * 2]    (slow tool probe)
+    #<z_slow_probe> = #5063
+    G90
+    G1 F[#<traverse_fr>] Z[#<z_slow_probe> + #<retract_distance>]
+o120 endif
+
+o130 if [#5070 EQ 1]    (verify probe event was succesful)
+    #<z_slow_probe> = #5063    (save slow probe result to parameters)
+o130 else
+    (DEBUG,Tool Length Offset Probe Failed)
+o130 endif
+
+(Tool Diameter Probe Mode Section, User must define this section as needed)
+o140 if [#<tool_diameter_probe_mode> EQ 1]
+    (DEBUG, Tool Diameter Probing is Not Defined in Subroutine)
+o140 endif
+
+o150 if [3 EQ 3]
+    G49
+o150 endif
+
+G90    (set absolute coordinates)
+G53 G1 F[#<traverse_fr>] Z0 (Send Spindle to home zero position)
+
+(define new tool length offset parameters)
+#<new_tool_length_offset> = [ABS[#<spindle_zero_height> + #5063 - #<offset_z>]]
+
+G10 L1 P #5400 Z [#<new_tool_length_offset>]  (5400 = tool number)
+
+T #5400 G43  H #5400    (enable tool length offset)
+
+M50 P1  (reinstate feedrate override)
+
+o<tool_touch_off> endsub
+
+M2 (end program)