Fix a bug where the PID controllers D action kicks in hard as soon as the PID controller starts.