Updated to work with ATMega32u4