DC motor control Xmega - Copy (1)