Updated Debug, moved configuration to ArduinoCopter.ino