Pi control for speed