Add test for close() method.
Add missing position.
Issue correct command for writing microseconds to serv.
Refactor test class to re-use.
Add servo tests.