Implemented PI controller