Make ISR function from polling function

[MicroBahner]

@1337ralfy

Just need to make it now with some other logic not with 5x -10x times "same" code lines

You could simply use a counter.
And instead of these if .. else if I would use a switch statement.
You need less ISR overhead if you let OCR1B switch your output.