Restructured PID controller. (Has not been built)