Cleanup fsensor_st_block_begin

This commit is contained in:
Yuri D'Elia 2019-06-02 15:01:56 +02:00
parent b4bf79297f
commit 5cd0177389

View file

@ -489,15 +489,13 @@ void fsensor_setup_interrupt(void)
#endif //PAT9125
void fsensor_st_block_begin(bool rev)
void fsensor_st_block_begin(bool rev __attribute__((unused)))
{
if (!fsensor_enabled) return;
if (fsensor_st_cnt && ((fsensor_st_cnt > 0) ^ rev))
{
// !!! bit toggling (PINxn <- 1) (for PinChangeInterrupt) does not work for some MCU pins
if (PIN_GET(FSENSOR_INT_PIN)) {PIN_VAL(FSENSOR_INT_PIN, LOW);}
else {PIN_VAL(FSENSOR_INT_PIN, HIGH);}
}
// There's really nothing to do here: the stepper ISR likely has called us
// already at the end of the last block, making this integration redundant.
// LA1.5 might not always do that during a coasting move, so attempt to drain
// fsensor_st_cnt anyway at the beginning of the new block.
fsensor_st_block_chunk(0);
}
void fsensor_st_block_chunk(int cnt)