Add Mega2560 support