Refactor of z probing for auto bed leveling

Current z-probing code has a lot of repeated code.  This patch refactors some of that into a single common function, `probe_pt()` which is called from a few different sites.