Code for Arduino Mega