Get working on Arduino Mega

This now works on the Arduino Mega. To select between the Uno and the
Mega, the correct include needs to be uncommented in SWTFT.cpp