(Tool length measure for RTCP control macro)
#100= 800.0 (Speed Z)
#101= 800.0 (Speed XY)
G28.2 X0 Y0 Z0(save current position into Position Register #1)
G53 G0 Z[#5433-1.0] F#100 (Move up to safe position)
G53 G0 X#5471 Y#5472 F#101 (move to Tool Sensor Position)

M88 P#10 L#11 (Smooth stop if sensor activated)
G91 G0 Z-100 F1000 (First fast probing)
G04 P0.1
G91 G0 Z3.0 F1000 (Move up to Gap)
M89 P#10 L#11 (Stop if sensor activated)
G91 G0 Z-6.0 F50 (Second slow probing )

G10 L81 P100 Q5043 (Store to #100 Current Z position)
G10 L190 P100 Q270  (Add 270 to #100)
G10 L81 P7215 Q100  (Store the result as RTCP Shoulder Length)

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 G90 G28.5 Z0 F#100 (move down to saved Z/Register1.Z)

M102 (Turn ON RTCP Correction)