- remove magic numbers for IO Pins, #define constants instead
- Make the code Leonardo compatible
- This has not been tested on a atmega328 (all my devices are atmega32u4 based)