🐛 Fix Bed Distance Sensor reading (#24649)

2022-08-26 06:50:03 +08:00
parent e24d5f9315
commit e8394c391e
2 changed files with 20 additions and 17 deletions
--- a/Marlin/src/module/probe.cpp
+++ b/Marlin/src/module/probe.cpp
@ -882,7 +882,9 @@ float Probe::probe_at_point(const_float_t rx, const_float_t ry, const ProbePtRai
  // Move the probe to the starting XYZ
  do_blocking_move_to(npos, feedRate_t(XY_PROBE_FEEDRATE_MM_S));

-  TERN_(BD_SENSOR, return bdl.read());
+  #if ENABLED(BD_SENSOR)
+    return current_position.z - bdl.read(); // Difference between Z-home-relative Z and sensor reading
+  #endif

  float measured_z = NAN;
  if (!deploy()) {