4bdc20ffb9
- Overhauled the state machine and cleaned up its overall operation. This involved creating a new ‘suspend’ state for what all external commands, except real-time commands, are ignored. All hold type states enter this suspend state. - Removed ‘auto cycle start’ setting from Grbl. This was not used by users in its intended way and is somewhat redundant, as GUI manage the cycle start by streaming. It also muddled up how Grbl should interpret how and when to execute a g-code block. Removing it made everything much much simpler. - Fixed a program pause bug when used with other buffer_sync commands. - New safety door feature for OEMs. Immediately forces a feed hold and then de-energizes the machine. Resuming is blocked until the door is closed. When it is, it re-energizes the system and then resumes on the normal toolpath. - Safety door input pin is optional and uses the feed hold pin on A1. Enabled by config.h define. - Spindle and coolant re-energizing upon a safety door resume has a programmable delay time to allow for complete spin up to rpm and turning on the coolant before resuming motion. - Safety door-style feed holds can be used instead of regular feed hold (doesn’t de-energize the machine) with a ‘@‘ character. If the safety door input pin is not enabled, the system can be resumed at any time.
69 lines
2.4 KiB
C
69 lines
2.4 KiB
C
/*
|
|
probe.c - code pertaining to probing methods
|
|
Part of Grbl v0.9
|
|
|
|
Copyright (c) 2014-2015 Sungeun K. Jeon
|
|
|
|
Grbl is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
Grbl is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with Grbl. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "grbl.h"
|
|
|
|
|
|
// Inverts the probe pin state depending on user settings and probing cycle mode.
|
|
uint8_t probe_invert_mask;
|
|
|
|
|
|
// Probe pin initialization routine.
|
|
void probe_init()
|
|
{
|
|
PROBE_DDR &= ~(PROBE_MASK); // Configure as input pins
|
|
#ifdef DISABLE_PROBE_PIN_PULL_UP
|
|
PROBE_PORT &= ~(PROBE_MASK); // Normal low operation. Requires external pull-down.
|
|
#else
|
|
PROBE_PORT |= PROBE_MASK; // Enable internal pull-up resistors. Normal high operation.
|
|
#endif
|
|
// probe_configure_invert_mask(false); // Initialize invert mask. Not required. Updated when in-use.
|
|
}
|
|
|
|
|
|
// Called by probe_init() and the mc_probe() routines. Sets up the probe pin invert mask to
|
|
// appropriately set the pin logic according to setting for normal-high/normal-low operation
|
|
// and the probing cycle modes for toward-workpiece/away-from-workpiece.
|
|
void probe_configure_invert_mask(uint8_t is_probe_away)
|
|
{
|
|
probe_invert_mask = 0; // Initialize as zero.
|
|
if (bit_isfalse(settings.flags,BITFLAG_INVERT_PROBE_PIN)) { probe_invert_mask ^= PROBE_MASK; }
|
|
if (is_probe_away) { probe_invert_mask ^= PROBE_MASK; }
|
|
}
|
|
|
|
|
|
// Returns the probe pin state. Triggered = true. Called by gcode parser and probe state monitor.
|
|
uint8_t probe_get_state() { return((PROBE_PIN & PROBE_MASK) ^ probe_invert_mask); }
|
|
|
|
|
|
// Monitors probe pin state and records the system position when detected. Called by the
|
|
// stepper ISR per ISR tick.
|
|
// NOTE: This function must be extremely efficient as to not bog down the stepper ISR.
|
|
void probe_state_monitor()
|
|
{
|
|
if (sys.probe_state == PROBE_ACTIVE) {
|
|
if (probe_get_state()) {
|
|
sys.probe_state = PROBE_OFF;
|
|
memcpy(sys.probe_position, sys.position, sizeof(float)*N_AXIS);
|
|
bit_true(sys.rt_exec_state, EXEC_MOTION_CANCEL);
|
|
}
|
|
}
|
|
}
|