Arduino code for quadcopter