Copied over code from ShifterBot
Merge branch 'master' of https://github.com/GirlsOfSteelRobotics/2015season.git