adding servo command
Merge pull request #29 from TimEvWw/master

Simple servo conrol