Tested autonomous, trying to get menu thing to work

It sorta works...