Deleted old auton code and added new code using a FSM.