Fixed pid update() logic, enc pulse 256/360