Updated to IterativeRobot

Cleaned up drive classes and updated to Iterative Robot (I hope). This
broke our autonomous code