Changed code to work on an Arduino Mega 2560.  Issues: Interrupts now conflict in FailSafeBoard