trying to implement RESET pid function