Fixed #6. Iterative: updated periodic calls

Added code that notifies user that the robot is in the disabled or test
mode. It slows disabledPeriodic() and testPeriodic() so that the
processor is safe in each of these modes.