Much update, very rewrite, wow.

Rewrote a majority of the code for the Adafruit Motor driver and Rover 5 Chassis.