Arduino code for quadcopter auto pilot