To makro musiałbyś napisać inaczej.
Czujnik pomiaru narzędzia nie musi być na poziomie materiału. (Oczywiście mowa o czujniku wys freza a nie wys. Materiału)
Generalnie aby makro chodziło poprawnie niezbędna jest zmienna określająca odległość pomiędzy płaszczyzną stołu a momentem zadziałania czujnika.

Czyli po każdym pomiarze mach będzie miał w tablicy offsetów dla każdego narzędzia zmierzoną odległość pomiędzy końcem freza a powierzchnią stołu. To oczywiście we współrzędnych maszynowych. Po złapaniu zera np na T1 i po zmianie narzędzia na T2 makro ma skompensować we współrzędnych maszynowych różnicę pomiędzy T1 a T2. I nie będzie tu grała roli grubość materiału.