Browse Source

Cleanup fsensor_st_block_begin

Yuri D'Elia 5 years ago
parent
commit
5cd0177389
1 changed files with 6 additions and 8 deletions
  1. 6 8
      Firmware/fsensor.cpp

+ 6 - 8
Firmware/fsensor.cpp

@@ -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)