Updated for Arduino 1.5 - Tested with promicro16