Controller library with implemented PID