Servo lib created + refactoring

-setServoAngle(angle, coordinate) function