Minimal probing cycle working. Supports both G38.2 for error and G38.3 when no errors are desired.
This commit is contained in:
parent
1fd45791a5
commit
0a46dfe0b9
10 changed files with 211 additions and 3 deletions
|
|
@ -282,6 +282,12 @@ ISR(TIMER1_COMPA_vect)
|
|||
{
|
||||
// SPINDLE_ENABLE_PORT ^= 1<<SPINDLE_ENABLE_BIT; // Debug: Used to time ISR
|
||||
if (busy) { return; } // The busy-flag is used to avoid reentering this interrupt
|
||||
|
||||
//Check if we need to copy the current position to the probe_position
|
||||
if(sys.probe_state == PROBE_COPY_POSITION){
|
||||
sys.probe_state = PROBE_OFF;
|
||||
memcpy(sys.probe_position, sys.position, sizeof(float)*N_AXIS);
|
||||
}
|
||||
|
||||
// Set the direction pins a couple of nanoseconds before we step the steppers
|
||||
DIRECTION_PORT = (DIRECTION_PORT & ~DIRECTION_MASK) | (st.dir_outbits & DIRECTION_MASK);
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue