Removed hardcoding of values

On a larger machine it was not using the SAFE_HOME_TO_ORIGIN_DISTANCE so
endstop probing took longer than it needed.