Changed working demo to support safe mode swapping.  Refactoring coming up, then a push to master.
Changed working demo to support safe mode swapping.  Refactoring coming up, then a push to master.

SquadCollaborativeRobotics/ArduinoCode,SquadCollaborativeRobotics/ArduinoCode,SquadCollaborativeRobotics/ArduinoCode