Some optimizations to run on AVR-GCC 4.9