Не выполняется парковка при Z_MULTI_ENDSTOPS

Добрый день!

Никак не могу разобраться. Имеется принтер на базе octopus pro с прошивкой Marlin-2.1.2.2 и проблема с парковкой оси z. Все оси кроме оси z паркуются хорошо. На ось z настроил два драйвера мотора, два мотора и поставил два концевика. Ось при команде перемещается и вверх и вниз. Все концевики по команде m119 открыты, когда зажимаю один из концевиков он реагирует и пишет что закрылся. Если нажать на все концевики они также корректно отрабатывают. Если загрузить прошивку без #define Z_MULTI_ENDSTOPS  то принтер адекватно паркуется. Если активировать два концевика по оси z при команде домой принтер тупо блокирует все моторы и падает по таймауту в ошибку парковки. Если в момент когда он заблокировал моторы одновременно зажать концевики оси z, то он успешно пройдет алгоритм парковки. Главный вопрос в том, как победить парковку по двум концевикам, с железной стороны проблем точно нет, концевики работают и показывают стабильный результат, моторы z оси перемещают печатающую головку, со стороны программы уже не знаю куда смотреть, работает нормально только при одном концевике z. Приложу ссылку на полный файл конфигурации на диске.

https://disk.yandex.ru/d/M__Ilsl-uu4WLA