Arduino code for quadcopter project