Added Servo Controls

To make a balancing project I added two servos, this handles pan and
tilt