Refactored a lot of the differential drive code