Fix/harden homing zprobe

Also fix a potential race condition