Adding RC controller to PID controller