Finished FailSafe in Autonomous Functions

Code Review: Rohan