Added support for two motors and sensor control

I also added daisy chaining via I2C.