Arduino sketch for I2C remote and servos