Refactoring

More abstracting has been done and now the automous has a menu. automous
is broken atm