3DPrinting/Prusa-Firmware
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity

Speedup advance_spread for common divisors

Browse source
This commit is contained in:
Yuri D'Elia 2019-05-25 21:38:59 +02:00
parent fa7ecfc38e
commit 935a798236
1 changed files with 9 additions and 3 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

12
Firmware/stepper.cpp
View file

@ -734,7 +734,14 @@ FORCE_INLINE void advance_spread(uint16_t timer)
else
eISR_Err -= timer - block;
eISR_Rate = timer / ticks;
if (ticks == 1)
eISR_Rate = timer;
else if (ticks == 2)
eISR_Rate = timer / 2;
else if (ticks == 4)
eISR_Rate = timer / 4;
else
eISR_Rate = timer / ticks;
nextAdvanceISR = eISR_Rate / 2;
}
#endif
@ -822,9 +829,8 @@ FORCE_INLINE void isr() {
}
_NEXT_ISR(OCR1A_nominal);
#ifdef LIN_ADVANCE
if (current_block->use_advance_lead && nextAdvanceISR != ADV_NEVER) {
if (current_block->use_advance_lead && nextAdvanceISR != ADV_NEVER)
advance_spread(OCR1A_nominal);
}
#endif
}
//WRITE_NC(LOGIC_ANALYZER_CH1, false);