adding servo handling
added servo command
Merge pull request #16 from TimEvWw/master

Simple servo control