Arduino code for Quadcopter