Updated motor control so that it doesn't crash the i2c bus.........