firmware switched to handle i2c servo controller

added firmware for UNO to act as servo controller. This is because of
DUE being 3.3v and UNO capable of 5v servos.