BFPTouch - слишком большие повороты сервы

Пробую собрать bfptouch. 

Плата - SKR 1.4 Turbo,

Прошивка - Malrin 2.0.5.2

Серва - SG90, endstop - TCST2103.

Серва подключена в порт для сервы на плате. 

В прошивке включен BLTOUCH, углы сервы заданы: Z_SERVO_ANGLES {110, 60}

Чудеса начинаются при включении принтера.

При включении, серва перемещается в позицию 160, потом на 90.

При M119 (статус концевиков) серва (зачем?) перемещается в 60, потом в 10.

При M43 S (проверка bltouch) серва перемещается на 160, потом на 90, потом 4 раза скачет 60-10. 

Выхлоп M43 S:

Send: M43 S

Recv: Servo probe test

Recv: . using index: 0, deploy angle: 10, stow angle: 90

Recv: . Probe Z_MIN_PROBE_PIN: 10

Recv: . Z_MIN_PROBE_ENDSTOP_INVERTING: false

Recv: . Check for BLTOUCH

Recv: . Deploy & stow 4 times

Recv: ** Please trigger probe within 30 sec **

Recv: . Pulse width: 30ms or more

Recv: = Z Servo Probe detected.

В configuration.h про эти углы ничего подобного нету. Но есть в src/feature/bltouch.h. Мне их там переопределять или я что-то не так понял? Просто сейчас серва машет на 140 градусов, а в корпусе BFPTouch дальше 50 градусов она упирается в стенки и начинает их ломать. 

И почему при M119 серва двигается?