Ported sample arduino servo code to work with adafruit i2c 16 channel, currently only works with one channel