Added things so that this project can do everything that the final robot should be able to do eg. shoot drive and pick up the ball.