|
|
@ -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;
|
|
|
|
|
|
|
|
|
|
|
|