Changed safety code

Added startup flag; robot will now disengage upon SRC2 power off is
safety is enabled.