Bag Code

This is the code as of the end of the build season. It has everything ready for competition with a few things that can be improved during the bag window, such as 20 tote autonomous.