M5
M9
G28.3 A0
(Tool length measure macro)
(#20 is fast speed motion length)
(#5421...#5428 - Work area Min)
(#5431...#5438 - Work area Max)
(#5471...#5479 - Tool Length Sensor position)
#100= 800.0 (Speed Z)
#101= 800.0 (Speed XY)
#102=  10.0 (Speed A)
#5471=  -6.573
#5472= -61.162
#5473= -110
G28.2 X0 Y0 Z0 A0 (save current position into Register1.Z)
(G10 L81 P202 Q5023 (save prog. Z)
#99 = #5043
G53 G0 Z[#5433-1.0] F#100
(Move up to safe position)
M5 (just in case)
G53 G0 X#5471 Y#5472 F#101 (move to Tool Sensor Position)
M134    (Home A)
G91 G0 Z[0-#20] F#100
G53 G90 G38.9 Z[#5473 - 20] F 200.0
G04 P0.2
G53 G0 Z[#5433-1.0] F#100
(Move up to safe position)
G53 G28.5 F#101 X0 Y0(move back to saved XY/Register1.XY)
G53 G28.5 F#102 A0   (move back to saved A)
(G53 G90 G28.5 Z0 F#100)

(G90 G28.5 Z0 F#100)
(G90 G0 B#202 F50)
(G90 G0 Z#202 F#100)
(G90 G0 B#99 F50 (debug)
G90 G0 Z#99 F#100

(move down to saved Z/Register1.Z)
(G28.6 A0 - no go)
M02
