Неправильная парковка оси Z после обновления прошивки

Доброго времени суток.

Установил новую прошивку Marlin 2.1.2 на свой принтер Anycubic i3 Mega S. Для настройки использовал конфигурацию из примеров скачанную с гитхаба, дорабатывая и настраивая под свои нужды. 

После установки стала неправильно работать парковка по оси Z.

Происходит следующее: после того как щуп оси z на одной из осей касается концевика, мотор не перестает работать и продолжает опускать ось ниже, начинается пропуск шагов и т.д., второй шаговый двигатель в этот момент не двигает ось вниз и не может выправить перекос отработав второе нажатие. Если вручную щелкнуть концевой выключатель, то команда отработает. Такое происходит для обоих концевиков.

То есть почему-то после срабатывания первого концевика, двигатель первой оси не выключается и не включается двигатель другой оси до нажатия на второй концевик.

Механика впорядке, коцевики впорядке. Поставил старую прошивку, все работает идеально.

В прошивке, включено две оси Z.

Подскажите пожалуйста почему такое может быть и как это исправить?