Added M31 to toggle Z probe state

M31 with nothing reports the status, M31 S0 = disable, M31 S1 = enable