Fixed Arduino Mega 2560 compatibility