First complete version of Shaker Robotics 2791 2016 code

This code has working auton, easy flexibility to switch between bots and the working perfected teleop... This is released after our first competition