Finish writing (and debug) IO interface
Algorithm tweaks: windup and explicit initialisation
Production Controller that actually does the PID controlling
Set the controller to Integral Only mode