Moved motor.setSafetyEnabled from autonomous to trainDrive
Merge pull request #6 from PHRED2014/Autonomous

Cleaned up code and implemented the autonomous routine.