Автоматическая калибровка стола BFPTouch

Собран принтер полностью из метала нет ни одно печатной детали, кроме одной это датчик авто уровня стола BFPTouch. До этого был датчик с сервой и микриком, как автоуровень работал плохо а вот как коцевик Домой прекрасно справлялся, но то что у него был рычаг при не аккуратном движение были сломаны шестиренки в серве. Было решено напечатать BFPTouch.

На его создание все было, старая серва со сломанной шестерёнкой которая починилась паяльником, Оптический концевик от принтера, и схемка с 2мя сопротивлениями и 1 диодом.

Исходники

Моя модификация под оптический датчик от принтера.

Сам датчик

Концевик выпилен отсюда 

Схема распайки 

Собирал я датчик тот что ( Slim ) не люблю громоздкость, в общем подводя итог, как автоуровень я его ни юзаю, служит он мне как концевик, почему именноконцевик, потомучто приходится снимать стекло что бы оторвать деталь и отмыть стекло, поменять на другое и заниматься рукоблудием каждый раз с подстраиванием концевика мне ни хочется.  А данный датчик прощает даже порой 3 мм искривления стола на маленькой детали, так как отбивка стола происходит в середине где и печатается деталь.

Оптический датчик подключен как штатный датчик вместо оси Zmin

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

Использую MEGA 2560 & RAMPS 1.4

Моя прошивка .

На Zmax и Ymax - подключен датчик окончания филамента и кнопка включения стола до 90градусов. на какой именно что не помню легко проверить замыканием контактов.