Autonomous QuadCopter stabilization code