Fix manual PID mode