Added a new class for the motors, to use I2C instead. Also cleaned up some code.