Added code to set PID parameters