Fixed Autonomous again (WhatIsThisIDon'tEven)

(WhatIsThisIDon'tEven)

I don't understand at all what I just coded. Give me a quick run through (again XC) and I'll fix it if it's broken.