arduino基于pwm驱动直流电机正反转，转不起来，求大神帮我看看程序有问题

const int KeyPin = 13;
const int PWM_ENA = 9;
const int N1=6;
const int N2=5;
int MOTOR_STATUS=0;
void setup() {
  pinMode(N1,OUTPUT);
  pinMode(N2,OUTPUT);
  pinMode(KeyPin,INPUT);
  pinMode(PWM_ENA,OUTPUT);
}
void PWM_PLUS(){
    const int rate = 700;
    digitalWrite(PWM_ENA,HIGH);
    delayMicroseconds(rate);
    digitalWrite(PWM_ENA,LOW);
    delayMicroseconds(1000-rate);
}
void ControlMotor(){
  switch(MOTOR_STATUS)
  {
    case0:
        digitalWrite(N1,LOW);
        digitalWrite(N2,LOW);
        break;
    case1:
        digitalWrite(N1,HIGH);
        digitalWrite(N2,LOW);
        break;
    case3:
        digitalWrite(N1,LOW);
        digitalWrite(N2,LOW);
        break;
    case4:
        digitalWrite(N1,LOW);
        digitalWrite(N2,HIGH);
        break;
    default:
        MOTOR_STATUS=0;
  }
}
void KeyDetect(){
    if(LOW==digitalRead(KeyPin))
    {
      delay(50);
      if(LOW==digitalRead(KeyPin))
       {
          MOTOR_STATUS++;
        }

    }  
}
void loop()
{
   KeyDetect();
   PWM_PLUS();
   ControlMotor();
}