Помогите подключить китайский 3D TOUCH

3D TOUCH (https://www.aliexpress.com/item/Trianglelab-3D-Printer-TOUCH-Free-Shipping-Auto-Leveling-Sensor-Auto-Leveling-3D-Printer-TOUCH-reprap-mk8/32832887426.html?spm=a2g0s.9042311.0.0.67fc4c4dPSMzwR).

Моя плата - что-то по типу mks base 1.3, но маркировка странная

В интернете есть распиновка и нормальное фото:

На странице продавца указана схема подключения:

Здесь на ресурсе нашёл нормальную картинку распиновка датчика ( http://3dtoday.ru/blogs/vasyna/chinese-bltouch-connection/ ):

Подключаю по такой схеме (цвет прямоугольников = цвет проводов):

При включении датчик дважды делает штоком туда-сюда (гаснет светодиод при вытягивании) и потом втягивает шток и горит постоянно (при ошибках, вроде должен мигать).

Но ни на какие команды M280 P0 S10 и M280 P0 S90 не реагирует никак (статус - Ок), на команды с дисплея тоже.

При команде 'домой' шток не вытягивается и как итог не работает.

Чувствую, что проблема в прошивке, т.к. механика вроде рабочая, но никак не пойму, что не так, прошу Вашей помощи, может кто сразу опытным глазом ошибку поймёт, я и углы менял на 0/70 и #define NUM_SERVOS менял...

Код из конфига = на гитхабе