Не получается автоуровень на Mk4Duo (kossel)

Итак, у меня самосборный коссел. Рампс 1.5, мега2560, датчик - оригинальный bltouch.  Cейчас едет due, буду переделывать под 32 бита, поэтому решил попробовать завести пока на меге. Сконфигурировал прошивку, все заработало, только одна проблема - при выборе автокалибровки из меню, или посылая команды g29, или g33 принтер из средней позиции начинает ехать наверх (как будто у него стол установлен сверху.) И естественно датчик не касается стола. В остальном все правильно, все пины верно указаны, в pronterface ездит вверх-вниз, пытается печатать модели нормально, только не могу сделать автокалибровку.

До этого был Клиппер, но там вообще все плохо с этим делом и автокалибровке можно было не мечтать, не получалось даже получить правильный сигнал с датчика, все время был triggered.