rewrite blinkencontrold in C (much faster)
rewrite avrshiftd in C as well