testing servo's and using i2c