PID I gain control  implemented