Changed to tank drive and fixed some broken stuff
Merge https://github.com/CAPS-Robotics/2015-xanthos