Matched k_p, k_i to encoder step change