SainSmart auto met Bluetooth (3 / 4 stap)

Stap 3: Codering voor de Bluetooth

Gebruik deze code om de Bluetooth-module program:

#include < SoftwareSerial.h >

Constanten voor de pinnen IN declareren
Const int rightForwardPin = 4;
Const int rightBackwardPin = 2;
Const int leftBackwardPin = 7;
Const int leftForwardPin = 5;

char incomingByte;

VOID Setup {}
Zet uw setup-code hier, om het eenmalig uit te voeren:
pinMode (rightForwardPin, OUTPUT);
pinMode (rightBackwardPin, OUTPUT);
pinMode (leftForwardPin, OUTPUT);
pinMode (leftBackwardPin, OUTPUT);
Serial.begin(9600);
}

void loop {}
Controles om te zien dat de seriële poort beschikbaar is (In putty/Tera Term/SENA BTerm)
Als (Serial.available() > 0) {}
De char komen in leest
incomingByte = Serial.read();
Als (incomingByte == 'w') {}
vooruit();
Serial.println ("Doorgaan");
}
Als (incomingByte == 'x') {}
backward();
Serial.println ("Going achteruit");
}
Als (incomingByte == de ') {}
stopCar();
Serial.println("stopping");
}
Als (incomingByte == had') {}
rechts();
Serial.println ("naar rechts");
}
Als (incomingByte == 'a') {}
datumwaarde;
Serial.println ("Going links");
}
}
}

De wielen om vooruit te gaan door de voorwaartse pinnen op hoog instellen
ongeldig vooruit() {}
digitalWrite (rightForwardPin, hoge);
digitalWrite (rightBackwardPin, laag);
digitalWrite (leftForwardPin, hoge);
digitalWrite (leftBackwardPin, laag);
}

De wielen te gaan achteruit door de achterwaartse pinnen op hoog instellen
ongeldig backward() {}
digitalWrite (rightForwardPin, laag);
digitalWrite (rightBackwardPin, hoge);
digitalWrite (leftForwardPin, laag);
digitalWrite (leftBackwardPin, hoge);
}

De wielen te gaan direct aan de rightBackwardPin en de leftForwardPin instellen op hoog instellen
VOID rechts() {}
digitalWrite (rightForwardPin, laag);
digitalWrite (rightBackwardPin, hoge);
digitalWrite (leftForwardPin, hoge);
digitalWrite (leftBackwardPin, laag);
}

De wielen naar links door de rightForwardPin en de leftBackwardPin te stellen op hoog instellen
VOID datumwaarde {}
digitalWrite (rightForwardPin, hoge);
digitalWrite (rightBackwardPin, laag);
digitalWrite (leftForwardPin, laag);
digitalWrite (leftBackwardPin, hoge);
}

De wielen te gaan stoppen door alle pins in te stellen op laag instellen
ongeldig stopCar() {}
digitalWrite (rightForwardPin, laag);
digitalWrite (rightBackwardPin, laag);
digitalWrite (leftForwardPin, laag);
digitalWrite (leftBackwardPin, laag);
}