Some testing/cleanup of the main servostat code

I read through the code and in the process, I couldn't prevent myself from adding some documentation/testing and cleaning up some syntactical/stylistic stuff.
* Added a unit test for controller.py
* Added more documentation in mytimer.py, controller.py.