(Surface measure macro)
G28.2 Z0 (save current Z into Register1.Z)
G10 L80 P5529 Q1 (Shock sensor disabled while IHC/Surface measure proceudre)
M89 L0 P15 (watch for input(P) releseased(L0))
G91 G0 Z -50.000 F 400.0
(move down, stop if sensor triggered)
G91 G0 Z 1.000 F 200.0
M89 L0 P15 (watch for input(P) releseased(L0))
G91 G0 Z -2.000 F 20.0

G4 P0.2

G90 G10 L81 P8171 Q5021
G90 G10 L81 P8172 Q5022
G90 G10 L81 P8173 Q5023

G90 G28.5 Z0. F 1000.0 (move back to saved Z(Register1.Z))
G10 L80 P5529 Q0 (Activate Shock sensor back)
