Fix and extend BLTouch support

2016-09-20 13:56:23 -05:00
parent 5cbed13f41
commit 13523cbf29
5 changed files with 31 additions and 18 deletions
--- a/Marlin/Marlin_main.cpp
+++ b/Marlin/Marlin_main.cpp
@@ -1883,7 +1883,7 @@ static void clean_up_after_endstop_or_probe_move() {

    // Check BLTOUCH probe status for an error
    #if ENABLED(BLTOUCH)
-      if (servo[Z_ENDSTOP_SERVO_NR].read() == BLTouchState_Error) { stop(); return true; }
+      if (TEST_BLTOUCH()) { stop(); return true; }
    #endif

    #if ENABLED(Z_PROBE_SLED)