Changes to autonomous

we changes stuff and now it works better
code: tyler
code review: everybody that saw it work multiple times on the field