Автоуровень по одной точке (Marlin 1.1.9)

День добрый!

Хочу настроить автоуровень стола на своем принтере (фанерный кубик, H-bot, стол хомится внизу по Z_max). Спаял схемку для пьезодатчика - планирую разместить под столом и подключить к Z_min концевику. Требуется помощь по настройке прошивки.

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

1. Парковка Z в максимум на большой (условно) скорости

2. Парковка XY

3. Перемещение сопла в центр стола

4. Подъем стола (быстро) до высоты 10мм (от сопла)

5. Медленный подъем стола до срабатывания датчика

6. Обнуление Z (или выставление оффсета?)

7. Profit Печать

С первыми четырьмя пунктами более-менее понятно, а вот как 5 и 6 сделать не знаю...