Update on code
Debugged Mega and Shield Code