Quadcopter library debugged