58 lines
1.4 KiB
Plaintext
58 lines
1.4 KiB
Plaintext
; caveat - this changes feed and abs/relative mode
|
|
|
|
O<probe> SUB
|
|
|
|
(print, _Probe_Axis= #<_Probe_Axis>)
|
|
(print, _Probe_Speed = #<_Probe_Speed>)
|
|
(print, _Probe_Retract = #<_Probe_Retract>)
|
|
(print, _Probe_Distance = #<_Probe_Distance>)
|
|
(print, _Probe_Diameter = #<_Probe_Diameter>)
|
|
(print, _Probe_System = #<_Probe_System>)
|
|
|
|
|
|
O<xaxis> if [#<_Probe_Axis> eq 0]
|
|
|
|
G91 G38.3 X#<_Probe_Distance> F#<_Probe_Speed>
|
|
O<xresult> if [#5070]
|
|
(MSG, probe succeeded)
|
|
G10 L20 P#<_Probe_System> X#<_Probe_Diameter>
|
|
G90 G0 X#<_Probe_Retract>
|
|
O<xresult> else
|
|
(MSG,probe failed)
|
|
G91 G0 X[0 - #<_Probe_Distance>]
|
|
O<xresult> endif
|
|
G90
|
|
O<xaxis> endif
|
|
|
|
O<yaxis> if [#<_Probe_Axis> eq 1]
|
|
|
|
G91 G38.3 y#<_Probe_Distance> F#<_Probe_Speed>
|
|
O<yresult> if [#5070]
|
|
(MSG, probe succeeded)
|
|
G10 L20 P#<_Probe_System> y#<_Probe_Diameter>
|
|
G90 G0 y#<_Probe_Retract>
|
|
O<yresult> else
|
|
(MSG,probe failed)
|
|
G91 G0 y[0 - #<_Probe_Distance>]
|
|
O<yresult> endif
|
|
G90
|
|
O<yaxis> endif
|
|
|
|
O<zaxis> if [#<_Probe_Axis> eq 2]
|
|
|
|
G91 G38.3 z#<_Probe_Distance> F#<_Probe_Speed>
|
|
O<zresult> if [#5070]
|
|
(MSG, probe succeeded)
|
|
G10 L20 P#<_Probe_System> z#<_Probe_Diameter>
|
|
G90 G0 z#<_Probe_Retract>
|
|
O<zresult> else
|
|
(MSG,probe failed)
|
|
G91 G0 z[0 - #<_Probe_Distance>]
|
|
O<zresult> endif
|
|
G90
|
|
O<zaxis> endif
|
|
|
|
O<probe> endsub
|
|
|
|
M2
|