Arduino使用HC05蓝牙模块控制小车

#include<SoftwareSerial.h>
SoftwareSerial mySerial(10,11);

　int negR = 40;//IN3
　int posR = 42;//IN4
　int pwmR = 3;//ENB

　int negL = 46;//IN2
　int posL = 48;//IN1
　int pwmL = 2;//ENA

char val;

const int Rspeed = 200;
const int Lspeed = 200;
void setup() {
  pinMode(negR,OUTPUT);
  pinMode(posR,OUTPUT);
  pinMode(pwmR,OUTPUT);
  pinMode(negL,OUTPUT);
  pinMode(posL,OUTPUT);
  pinMode(pwmL,OUTPUT);
  Serial.begin(38400);
}


void loop()
{
  while(Serial.available())
  {
    val = Serial.read();
    if(val == ‘0‘)
      pause(0,0);
    else if(val == ‘1‘)
      forward(Rspeed,Lspeed);
    else if(val == ‘2‘)
      back(Rspeed,Lspeed);
    else if(val == ‘3‘)
      right(Rspeed,Lspeed);
    else if(val == ‘4‘)
      left(Rspeed,Lspeed);
    }
}

void forward(byte RmotorSpeed,byte LmotorSpeed)
{
  analogWrite(pwmR,RmotorSpeed);
  analogWrite(pwmL,LmotorSpeed);
  digitalWrite(posR,HIGH);
  digitalWrite(negR,LOW);
  digitalWrite(posL,LOW);
  digitalWrite(negL,HIGH);
}

void back(byte RmotorSpeed,byte LmotorSpeed)
{
  analogWrite(pwmR,RmotorSpeed);
  analogWrite(pwmL,LmotorSpeed);
  digitalWrite(posR,LOW);
  digitalWrite(negR,HIGH);
  digitalWrite(posL,HIGH);
  digitalWrite(negL,LOW);
}

void pause(byte RmotorSpeed,byte LmotorSpeed)
{
  analogWrite(pwmR,RmotorSpeed);
  analogWrite(pwmL,LmotorSpeed);
  digitalWrite(posR,LOW);
  digitalWrite(negR,LOW);
  digitalWrite(posL,LOW);
  digitalWrite(negL,LOW);
}

void right(byte RmotorSpeed,byte LmotorSpeed)
{
  analogWrite(pwmR,RmotorSpeed);
  analogWrite(pwmL,LmotorSpeed);
  digitalWrite(posR,LOW);
  digitalWrite(negR,LOW);
  digitalWrite(posL,LOW);
  digitalWrite(negL,HIGH);
}

void left(byte RmotorSpeed,byte LmotorSpeed)
{
  analogWrite(pwmR,RmotorSpeed);
  analogWrite(pwmL,LmotorSpeed);
  digitalWrite(posR,HIGH);
  digitalWrite(negR,LOW);
  digitalWrite(posL,LOW);
  digitalWrite(negL,LOW);
}