Ошибок в математике нет, т.к используется "родная" математика без изменений. Проблемы с резьбой решаются правильной настройкой датчиков, верной установкой перемычек. У Вас похоже не всегда "схватывается" ноль метка. Проверьте выставлен ли ток 90 мА на светодиоды датчиков. При удалении старой НЦ31 изменилась нагрузка на первичный блок питания, ток мог "уплыть".