QuadCopter implementation for the ATmega2560