Reset for PID now working