G31 now waits for moves to end before measuring/reporting.  G30 implemented.  Has argument Pn n = 0,1,2 - takes probe reading at current XY and calls them point n for the purpose of bed plane calculation.  Add an S field on the last probe (i.e. when n=2 usually, though you can do them in any order) to get it to fit the bed plane.