Add some comments to servostat.py.
More documentation of controller.py
Some more documentation of controller.py