p and i step response working