|
|
|
@ -218,17 +218,18 @@ inline void servo_probe_test() {
|
|
|
|
|
if (deploy_state != READ(PROBE_TEST_PIN)) { // probe triggered
|
|
|
|
|
for (probe_counter = 0; probe_counter < 15 && deploy_state != READ(PROBE_TEST_PIN); ++probe_counter) safe_delay(2);
|
|
|
|
|
|
|
|
|
|
SERIAL_ECHOPGM(". Pulse width");
|
|
|
|
|
if (probe_counter == 15)
|
|
|
|
|
SERIAL_ECHOLNPGM(". Pulse width: 30ms or more");
|
|
|
|
|
SERIAL_ECHOLNPGM(": 30ms or more");
|
|
|
|
|
else
|
|
|
|
|
SERIAL_ECHOLNPAIR(". Pulse width (+/- 4ms): ", probe_counter * 2);
|
|
|
|
|
SERIAL_ECHOLNPAIR(" (+/- 4ms): ", probe_counter * 2);
|
|
|
|
|
|
|
|
|
|
if (probe_counter >= 4) {
|
|
|
|
|
if (probe_counter == 15) {
|
|
|
|
|
if (blt) SERIAL_ECHOPGM("= BLTouch V3.1");
|
|
|
|
|
else SERIAL_ECHOPGM("= Z Servo Probe");
|
|
|
|
|
}
|
|
|
|
|
else SERIAL_ECHOPGM("= BLTouch pre V3.1 or compatible probe");
|
|
|
|
|
else SERIAL_ECHOPGM("= BLTouch pre V3.1 (or compatible)");
|
|
|
|
|
SERIAL_ECHOLNPGM(" detected.");
|
|
|
|
|
}
|
|
|
|
|
else SERIAL_ECHOLNPGM("FAIL: Noise detected - please re-run test");
|
|
|
|
@ -238,7 +239,7 @@ inline void servo_probe_test() {
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (!probe_counter) SERIAL_ECHOLNPGM("FAIL: Trigger not detected");
|
|
|
|
|
if (!probe_counter) SERIAL_ECHOLNPGM("FAIL: No trigger detected");
|
|
|
|
|
|
|
|
|
|
#endif // HAS_Z_SERVO_PROBE
|
|
|
|
|
|
|
|
|
|