probe.c: bug fix.  int for original position isntead of using int32_t.
  This caused roundoff erros under overflow conditions making the z probe
  not return to original position if the distance was too great.
  fixed and functioning now.