Added working servo module

Added:
- servo module

Modified:
- project name in makefile