add BLTouch retry to a second place & add/update delays
================================================= implement requested changes ================================================= remove delays (they're in another PR) & move return
This commit is contained in:
parent
a5abc61fb9
commit
a44b3432c1
1 changed files with 18 additions and 2 deletions
|
@ -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);
|
||||||
|
|
Reference in a new issue