Mach 3, czujnik wysokości narzędzia

Witam
1. Mam problem z czujnikiem wysokości narzędzia a właściwie ze skryptem.
Używam skryptu z tego forum lecz jest problem bo za każdym razem po zmierzeniu narzędzia wyskakuje kompensacja 158.563534-coś tam. Nie ważne czy to narzędzie 2 czy 22.
2. Po wciśnięciu przycisku auto tool zero wyskakuje błąd "not yet implemented", muszę robić pomiary przez edytor skryptu.
Skrypt w załączniku Dodane 24 minuty 28 sekundy:
Ok. Problem 2 rozwiązałem. Pozostaje 1.