Added shooter PID function