Arduino sketch added

Written with an Arduino Mega 2560 in mind.