Update robot code to work with newest pyfrc