Настройка автоуровня стола на серве и оптическом концевике

Пытаюсь настроить [SIZE=2]авто уровень стола с использованием сервы и оптического концевика.

[SIZE=2]Принтер - клон ultimaker от plastmaski

[SIZE=2]Конструкцию механизма на серве рисовал сам, т.к не нашел подходящей по габаритам

[SIZE=2]Концевик подключен в z-min - Z_MIN_PROBE_USES_Z_MIN_ENDSTOP_PIN.

[SIZE=2]Серва сидит на pin D11. Плата mks gen l,

С механикой и подключением к плате проблем нет.

Выставлены правильные офсеты

#define X_PROBE_OFFSET_FROM_EXTRUDER -32 // X offset: -left +right [of the nozzle]

#define Y_PROBE_OFFSET_FROM_EXTRUDER -25 // Y offset: -front +behind [the nozzle]

#define Z_PROBE_OFFSET_FROM_EXTRUDER -6.4 // Z offset: -below +above [the nozzle]

По G29 выполняется зондирование по 9 точкам

Cерва опускает шток, головка ездит, концевик меряет расстояние. Все ОК

Но по факту принтер печатает в воздухе

В Pronterface после запуска G29 получаю:

Bilinear Leveling Grid:

0 1 2

0 +7.023 +7.105 +7.080

1 +6.925 +6.985 +6.965

2 +6.853 +6.918 +6.882

Если сразу запускаю G29 повторно, то уже

Bilinear Leveling Grid:

0 1 2

0 +3.577 +3.647 +3.627

1 +3.467 +3.530 +3.517

2 +3.402 +3.470 +3.432

Если в третий раз запустить G29, то они становятся еще меньше.

Если выполнить G28, а потом снова G29, они станут снова как в первом случае

По видимому, каждый раз добавляется какое то значение

Сами измерения выполняются достаточно точно, если делать G29 +G28, от они будут отличаться где то на 0,003....0,005

Сколько не пытался, не могу понять и победить эту проблему