Manual Z Probe (and some code to get a servo working)

The Prusa i3 from Prusa Reseach uses a Mini-Rambo board which does not have a connection for a servo so this is a manual Z-Probe.
BOM
1 x small micro switch the same as the Z End Stop one
1 x 3mmx20mm screw
2 x 3mm nuts or 1 x 3mm locknut
1 x small sprint 10mm long

Wire in series with Z End Stop switch.

For setup follow the Zennmasters videos at
https://www.youtube.com/watch?v=6msLOR_EfKc&list=LLhZVdzyiZNM0MAZBqKICWkw&index=3

but ignore the servo stuff.

EDIT: Added some code i