Arduino 控制小车转动程序

#define E1 5
#define M1 4
#define E2 7
#define M2 6
/*  
  E1 - HIGH 后转 / LOW 前转
  M1 - 换向
  E2 - HIGH 前转 / LOW 后转
  M2 - 换向
*/
char cmd;
int data;
void setup() {
  pinMode(E1,OUTPUT);
  pinMode(M1,OUTPUT);
  pinMode(E2,OUTPUT);
  pinMode(M2,OUTPUT);
  Serial.begin(9600);
}
void runCmd(){
  switch(cmd){
    case 'p':
      digitalWrite(data,!digitalRead(data));
      break;
  }
}
void loop() {
  if(Serial.available()){//检查串口缓存是否有数据等待传输
      cmd=Serial.read();
      Serial.print(F("cmd="));
      Serial.print(cmd);
      Serial.print(F(","));
      data=Serial.parseInt();
      Serial.print(F("data="));
      Serial.print(data);
      Serial.println();
      runCmd();
  }
}