Make compiler generate proper code.

Add attributes to some functions so GCC unrolls the Init loop and
gerates sbi / cbi instructions. Ironically the unrolled loop codesize is
now smaller than if it is compiled with -Os.