Fixed G31 for Z endstop switch