G30 command updated to support variable feedrates. 

This hopefully increases Z Probe measurements