Quadcopter Flight Control Code