Trying PI controller