Added I2C interface to control servos. AnalogWrite doesn't work on its own.