Added set_angle functionality to Servo Library