Quadcopter code for ARDrone 2 and AeroQuad