MPCNC/Firmware
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Format probe stowed test code

Browse Source
This commit is contained in:
Scott Lahteine 2016-08-06 14:24:05 -07:00
parent f37e8a31d7
commit a00783c41f
1 changed files with 27 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

30
Marlin/Marlin_main.cpp
View File

@ -2063,30 +2063,36 @@ static void clean_up_after_endstop_or_probe_move() {
float oldYpos = current_position[Y_AXIS]; // save y position float oldYpos = current_position[Y_AXIS]; // save y position
#ifdef _TRIGGERED_WHEN_STOWED_TEST #ifdef _TRIGGERED_WHEN_STOWED_TEST
// If endstop is already false, the Z probe is deployed // If endstop is already false, the Z probe is deployed
if (_TRIGGERED_WHEN_STOWED_TEST == deploy) { // closed after the probe specific actions. if (_TRIGGERED_WHEN_STOWED_TEST == deploy) { // closed after the probe specific actions.
// Would a goto be less ugly? // Would a goto be less ugly?
//while (!_TRIGGERED_WHEN_STOWED_TEST) { idle(); // would offer the opportunity //while (!_TRIGGERED_WHEN_STOWED_TEST) idle(); // would offer the opportunity
// for a triggered when stowed manual probe. // for a triggered when stowed manual probe.
if(!deploy) endstops.enable_z_probe( deploy ); // Switch off triggered when stowed probes early
// Else a Allen-Key probe can't be stowed. if (!deploy) endstops.enable_z_probe(false); // Switch off triggered when stowed probes early
// otherwise an Allen-Key probe can't be stowed.
#endif #endif
#if ENABLED(Z_PROBE_SLED) #if ENABLED(Z_PROBE_SLED)
dock_sled(!deploy); dock_sled(!deploy);
#elif HAS_Z_SERVO_ENDSTOP #elif HAS_Z_SERVO_ENDSTOP
servo[Z_ENDSTOP_SERVO_NR].move(z_servo_angle[((deploy) ? 0 : 1)]);
servo[Z_ENDSTOP_SERVO_NR].move(z_servo_angle[deploy ? 0 : 1]);
#elif ENABLED(Z_PROBE_ALLEN_KEY) #elif ENABLED(Z_PROBE_ALLEN_KEY)
if (!deploy) run_stow_moves_script();
else run_deploy_moves_script(); deploy ? run_deploy_moves_script() : run_stow_moves_script();
#else
// Nothing to be done. Just enable_z_probe below...
#endif #endif
#ifdef _TRIGGERED_WHEN_STOWED_TEST #ifdef _TRIGGERED_WHEN_STOWED_TEST
}; // opened before the probe specific actions } // _TRIGGERED_WHEN_STOWED_TEST == deploy
if (_TRIGGERED_WHEN_STOWED_TEST == deploy) { // State hasn't changed?
if (_TRIGGERED_WHEN_STOWED_TEST == deploy) {
if (IsRunning()) { if (IsRunning()) {
SERIAL_ERROR_START; SERIAL_ERROR_START;
SERIAL_ERRORLNPGM("Z-Probe failed"); SERIAL_ERRORLNPGM("Z-Probe failed");
@ -2094,7 +2100,9 @@ static void clean_up_after_endstop_or_probe_move() {
} }
stop(); stop();
return true; return true;
}
} // _TRIGGERED_WHEN_STOWED_TEST == deploy
#endif #endif
do_blocking_move_to(oldXpos, oldYpos, current_position[Z_AXIS]); // return to position before deploy do_blocking_move_to(oldXpos, oldYpos, current_position[Z_AXIS]); // return to position before deploy