I am modifying the Elegoo smart car V3 and i can not get the Bluetooth to work. I can not find or fix the problem in my code. The Bluetooth can not connect to a device. If someone can help it would be appreciated.
//www.elegoo.com
#include <Servo.h> //servo
Servo myservo; //servo
int pos = 90;
#define ENA 5
#define ENB 6
#define IN1 7
#define IN2 8
#define IN3 9
#define IN4 11
#define LED1 13
unsigned char carSpeed = 250;
bool state = LOW;
char getstr;
void forward(){
myservo.write(pos);
digitalWrite(ENA,HIGH);
digitalWrite(ENB,HIGH);
digitalWrite(IN1,HIGH);
digitalWrite(IN2,LOW);
digitalWrite(IN3,LOW);
digitalWrite(IN4,HIGH);
Serial.println("Forward");
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void back(){
myservo.write(pos);
digitalWrite(ENA,HIGH);
digitalWrite(ENB,HIGH);
digitalWrite(IN1,LOW);
digitalWrite(IN2,HIGH);
digitalWrite(IN3,HIGH);
digitalWrite(IN4,LOW);
Serial.println("Back");
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void left(){
myservo.write(pos);
analogWrite(ENA,carSpeed);
analogWrite(ENB,carSpeed);
digitalWrite(IN1,LOW);
digitalWrite(IN2,HIGH);
digitalWrite(IN3,LOW);
digitalWrite(IN4,HIGH);
Serial.println("Left");
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void right(){
myservo.write(pos);
analogWrite(ENA,carSpeed);
analogWrite(ENB,carSpeed);
digitalWrite(IN1,HIGH);
digitalWrite(IN2,LOW);
digitalWrite(IN3,HIGH);
digitalWrite(IN4,LOW);
Serial.println("Right");
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void RightForwardSlow(){
for (pos = 90; pos <= 135; pos += 1)
digitalWrite(ENA,HIGH);
digitalWrite(ENB,HIGH);
digitalWrite(IN1,HIGH);
digitalWrite(IN2,LOW);
digitalWrite(IN3,LOW);
digitalWrite(IN4,HIGH);
Serial.println("RightForwardSlow");
myservo.write(pos);
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void RightForwardFast(){
for (pos = 90; pos <= 160; pos += 1)
digitalWrite(ENA,HIGH);
digitalWrite(ENB,HIGH);
digitalWrite(IN1,HIGH);
digitalWrite(IN2,LOW); //RightForwardFast
digitalWrite(IN3,LOW);
digitalWrite(IN4,HIGH);
Serial.println("RightForwardFast");
myservo.write(pos);
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void LeftForwardSlow(){
for (pos = 90; pos <= 45; pos += 1)
digitalWrite(ENA,HIGH);
digitalWrite(ENB,HIGH);
digitalWrite(IN1,HIGH);
digitalWrite(IN2,LOW);
digitalWrite(IN3,LOW);
digitalWrite(IN4,HIGH);
Serial.println("LeftForwardSlow");
myservo.write(pos);
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void LeftForwardFast(){
for (pos = 90; pos <= 20; pos += 1)
digitalWrite(ENA,HIGH);
digitalWrite(ENB,HIGH);
digitalWrite(IN1,HIGH);
digitalWrite(IN2,LOW);
digitalWrite(IN3,LOW);
digitalWrite(IN4,HIGH);
Serial.println("LeftForwardFast");
myservo.write(pos);
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void stop(){
myservo.write(pos);
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
Serial.println("Stop!");
}
void BackSlowRight(){
for (pos = 90; pos <= 135; pos += 1)
digitalWrite(ENA,HIGH);
digitalWrite(ENB,HIGH);
digitalWrite(IN1,LOW);
digitalWrite(IN2,HIGH);
digitalWrite(IN3,HIGH);
digitalWrite(IN4,LOW);
Serial.println("BackSlowRight");
myservo.write(pos);
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void BackFastRight(){
for (pos = 90; pos <= 160; pos += 1)
digitalWrite(ENA,HIGH);
digitalWrite(ENB,HIGH);
digitalWrite(IN1,LOW);
digitalWrite(IN2,HIGH);
digitalWrite(IN3,HIGH);
digitalWrite(IN4,LOW);
Serial.println("BackFastRight");
myservo.write(pos);
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void BackFastLeft(){
for (pos = 90; pos <= 20; pos += 1)
digitalWrite(ENA,HIGH);
digitalWrite(ENB,HIGH);
digitalWrite(IN1,LOW);
digitalWrite(IN2,HIGH);
digitalWrite(IN3,HIGH);
digitalWrite(IN4,LOW);
Serial.println("BackFastLeft");
myservo.write(pos);
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void BackSlowLeft(){
for (pos = 90; pos <= 45; pos += 1)
digitalWrite(ENA,HIGH);
digitalWrite(ENB,HIGH);
digitalWrite(IN1,LOW);
digitalWrite(IN2,HIGH);
digitalWrite(IN3,HIGH);
digitalWrite(IN4,LOW);
Serial.println("BackSlowLeft");
myservo.write(pos);
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
}
void stateChange(){
state = !state;
digitalWrite(LED1, state);
Serial.println("Light");
}
void DontGo(){
myservo.write(pos);
digitalWrite(ENA,LOW);
digitalWrite(ENB,LOW);
Serial.println("stop");
}
void setup() {
Serial.begin(9600);
myservo.attach(9);
pinMode(LED1, OUTPUT); //this down to stop is motor
pinMode(IN1,OUTPUT);
pinMode(IN2,OUTPUT);
pinMode(IN3,OUTPUT);
pinMode(IN4,OUTPUT);
pinMode(ENA,OUTPUT);
pinMode(ENB,OUTPUT);
stop();
}
void loop() {
getstr = Serial.read();
Serial.print(getstr);
switch(getstr)
case 'f': forward(); return;
switch(getstr)
case 'm': back(); return;
switch(getstr)
case 'l': left(); return;
switch(getstr)
case 'r': right(); return;
switch(getstr)
case 'n': RightForwardSlow(); return;
switch(getstr)
case 'o': RightForwardFast(); return;
switch(getstr)
case 'd': LeftForwardSlow(); return;
switch(getstr)
case 'h': LeftForwardFast(); return;
switch(getstr)
case 'k': BackSlowRight(); return;
switch(getstr)
case 'g': BackFastRight(); return;
switch(getstr)
case 'u': BackFastLeft(); return;
switch(getstr)
case 'w': BackSlowLeft(); return;
switch(getstr)
case 'a': stateChange(); return;
switch(getstr)
case 's': DontGo(); return;
switch(getstr)
default: return;
}