Adding ATMega16U2 support, and fixing USB issues