Merge pull request #6114 from Bob-the-Kuhn/try2-add-BLTouch-retry
Another BLTouch retry place (replaces PR #6108)
This commit is contained in:
commit
a77875c9d2
|
@ -1993,6 +1993,19 @@ static void clean_up_after_endstop_or_probe_move() {
|
||||||
}
|
}
|
||||||
|
|
||||||
void set_bltouch_deployed(const bool deploy) {
|
void set_bltouch_deployed(const bool deploy) {
|
||||||
|
if (deploy && TEST_BLTOUCH()) { // If BL-Touch says it's triggered
|
||||||
|
bltouch_command(BLTOUCH_RESET); // try to reset it.
|
||||||
|
bltouch_command(BLTOUCH_DEPLOY); // Also needs to deploy and stow to
|
||||||
|
bltouch_command(BLTOUCH_STOW); // clear the triggered condition.
|
||||||
|
safe_delay(1500); // wait for internal self test to complete
|
||||||
|
// measured completion time was 0.65 seconds
|
||||||
|
// after reset, deploy & stow sequence
|
||||||
|
if (TEST_BLTOUCH()) { // If it still claims to be triggered...
|
||||||
|
SERIAL_ERROR_START;
|
||||||
|
SERIAL_ERRORLNPGM(MSG_STOP_BLTOUCH);
|
||||||
|
stop(); // punt!
|
||||||
|
}
|
||||||
|
}
|
||||||
bltouch_command(deploy ? BLTOUCH_DEPLOY : BLTOUCH_STOW);
|
bltouch_command(deploy ? BLTOUCH_DEPLOY : BLTOUCH_STOW);
|
||||||
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
||||||
if (DEBUGGING(LEVELING)) {
|
if (DEBUGGING(LEVELING)) {
|
||||||
|
@ -2023,8 +2036,11 @@ static void clean_up_after_endstop_or_probe_move() {
|
||||||
#if ENABLED(BLTOUCH)
|
#if ENABLED(BLTOUCH)
|
||||||
if (deploy && TEST_BLTOUCH()) { // If BL-Touch says it's triggered
|
if (deploy && TEST_BLTOUCH()) { // If BL-Touch says it's triggered
|
||||||
bltouch_command(BLTOUCH_RESET); // try to reset it.
|
bltouch_command(BLTOUCH_RESET); // try to reset it.
|
||||||
set_bltouch_deployed(true); // Also needs to deploy and stow to
|
bltouch_command(BLTOUCH_DEPLOY); // Also needs to deploy and stow to
|
||||||
set_bltouch_deployed(false); // clear the triggered condition.
|
bltouch_command(BLTOUCH_STOW); // clear the triggered condition.
|
||||||
|
safe_delay(1500); // wait for internal self test to complete
|
||||||
|
// measured completion time was 0.65 seconds
|
||||||
|
// after reset, deploy & stow sequence
|
||||||
if (TEST_BLTOUCH()) { // If it still claims to be triggered...
|
if (TEST_BLTOUCH()) { // If it still claims to be triggered...
|
||||||
SERIAL_ERROR_START;
|
SERIAL_ERROR_START;
|
||||||
SERIAL_ERRORLNPGM(MSG_STOP_BLTOUCH);
|
SERIAL_ERRORLNPGM(MSG_STOP_BLTOUCH);
|
||||||
|
|
Loading…
Reference in a new issue