Reimplemented PID without a separate class for control variables