PID control for each control mode