Fixed everything

Added a robot commands class to simplify things and made xbox nonsense
work.