Z-щуп для установки высоты инструмента в автоматическом режиме Candle для ЧПУ CNC 3018 PRO

Имеется фрезерный станок CNC3018 PRO, управляющая плата WOODPECKER 3.2A, прошивка Grbl 1.1f На али купил сам щуп (датчик+крокодил), заменил провод на витой, на конец провода одел двойной пин для подключения к плате. На плате для этого нужен плюсовой контакт "A5" и минусовой контакт "GND" под ним. Крокодил цепляется к фрезе, под нее кладется датчик. Программа Candle 1.1.8 умеет работать с Z-щупом, требуется лишь подкорректировать набор команд для управления им, как минимум указать высоту датчика. G-коды выставил следующие, далее приведу их расшифровку для понимания алгоритма работы: G21 - указание работы в метрической системе, G91 - использование относительных координат, G38.2Z-50F80 - движение щупа по направлению к заготовке на 50мм вниз со скоростью 80мм/мин, остановка при касании датчика, после G0Z0.5 - "отскок" вверх на 0,5мм, снова G38.2Z-2F20 - щуп вниз на пару миллиметров, но с медленной скоростью 20мм/мин для повышения точности, G92Z10.0 - выставляет 0 по оси Z с 10мм поправкой на высоту датчика, G0Z1 подъем на 1мм вверх для облегчения вытаскивания датчика из под фрезы.