cleaning up code for team A autonomous