Moved motor.setSafetyEnabled from autonomous to trainDrive