Проблема с концевиками на прошивке Teacup

Проблема следующая:

При срабатывании концевика (х_min:triggered) по осях Х или Y движение останавливается, но в то же время и останавливается исполнение кода. Невозможно отправить следующую команду или получить ответ.

Если концевик перевести в положение (х_min:open) то исполнение кода продолжается (получаю текущие значения положения экструдера и могу отправлять следующие команды).

Что предпринимал (не помогло):

1. Инвертировал все что можно (менял провода на концевиках NO и NC при этом инвертировал сигнал).

2. Убирал, программно, подтягивающий резистор, испольльзовал реальный на 10КОм.

3. Менял значение #define ENDSTOP_STEPS

При этом по оси Z все нормально: после наезда на концевик ось немного отъезжает назад и снова на него наезжает, и программа продолжает работать.

Как можно решить эту проблему или где прячутся настойки НОМЕ чтобы можно было дублировать поведение для осей X и Y как для оси Z.

Спасибо!