... dico che, più di una semplicità, è di una lentezza disarmate !
Ma siete matti ad usare su piccole MCU a 8 bit operazioni matematiche (moltiplicazione) invece che, dove possibile, gli shift ? ? ? .... non ho verificato ... mi auguro solo che il compilatore, estremamente più ottimizzato di voi 
, si accorga che state facendo una moltiplicazione per due (che è uno << 1) e la trasformi lui in uno shift ... così da riportare in "come va fatto" quello che state facendo ! 
Guglielmo