Fixing PID Updating