mach3+bl-usbmach-2.1 не выполняется код G31

Прошу помощи! Взял чпу фрезерный с али. Работает нормально, но есть проблема с построением карты высот(ну очень нужно). При запуске программы сканирования шпиндель вниз сам по себе не опускается, строки с G31 пропускаются. Но если контакты щупа замкнуть и разомкнуть, то шпиндель опускается до касания. Авто поиск нуля происходит как положено - при нажатии клавиши в mach, шпиндель опускается до касания, без проблем. в чем может быть проблема? Как ее можно решить? Контроллер bl-usbmach v 2.1, софт mach3.