Final arduino code