motor control over i2c now working