|
@ -667,8 +667,8 @@ float Probe::probe_at_point(const float &rx, const float &ry, const ProbePtRaise |
|
|
if (bltouch.triggered()) bltouch._reset(); |
|
|
if (bltouch.triggered()) bltouch._reset(); |
|
|
#endif |
|
|
#endif |
|
|
|
|
|
|
|
|
// TODO: Adapt for SCARA, where the offset rotates
|
|
|
// On delta keep Z below clip height or do_blocking_move_to will abort
|
|
|
xyz_pos_t npos = { rx, ry }; |
|
|
xyz_pos_t npos = { rx, ry, _MIN(TERN(DELTA, delta_clip_start_height, current_position.z), current_position.z) }; |
|
|
if (probe_relative) { // The given position is in terms of the probe
|
|
|
if (probe_relative) { // The given position is in terms of the probe
|
|
|
if (!can_reach(npos)) { |
|
|
if (!can_reach(npos)) { |
|
|
if (DEBUGGING(LEVELING)) DEBUG_ECHOLNPGM("Position Not Reachable"); |
|
|
if (DEBUGGING(LEVELING)) DEBUG_ECHOLNPGM("Position Not Reachable"); |
|
@ -678,15 +678,6 @@ float Probe::probe_at_point(const float &rx, const float &ry, const ProbePtRaise |
|
|
} |
|
|
} |
|
|
else if (!position_is_reachable(npos)) return NAN; // The given position is in terms of the nozzle
|
|
|
else if (!position_is_reachable(npos)) return NAN; // The given position is in terms of the nozzle
|
|
|
|
|
|
|
|
|
npos.z = |
|
|
|
|
|
#if ENABLED(DELTA) |
|
|
|
|
|
// Move below clip height or xy move will be aborted by do_blocking_move_to
|
|
|
|
|
|
_MIN(current_position.z, delta_clip_start_height) |
|
|
|
|
|
#else |
|
|
|
|
|
current_position.z |
|
|
|
|
|
#endif |
|
|
|
|
|
; |
|
|
|
|
|
|
|
|
|
|
|
const float old_feedrate_mm_s = feedrate_mm_s; |
|
|
const float old_feedrate_mm_s = feedrate_mm_s; |
|
|
feedrate_mm_s = XY_PROBE_FEEDRATE_MM_S; |
|
|
feedrate_mm_s = XY_PROBE_FEEDRATE_MM_S; |
|
|
|
|
|
|
|
|