Min fjärde projekt: Smart Tank chassi med Bluetooth (3 / 5 steg)
Steg 3: kod
Koden är mycket lik föregående utom den inledande Bluetooth pin inställningen och den sista slingan. Till exempel: om Bluetooth ta emot en skrivelse "w", då tanken rör sig framåt.
#include < SoftwareSerial.h >
SoftwareSerial BT(6, 7); som TX och RX på bluetooth till stift 6 och 7 respektive
röding, kommando;
int motorPin = 8; höger sida till IB - framåt
int motorPin2 = 9; vänster sida till IA - framåt
int motorPin3 = 10; höger sida till IA - bakåt
int motorPin4 = 11; vänster sida till IB - bakåt
void setup() {
BT.begin (9600);
pinMode (motorPin, produktionen);
pinMode (motorPin2, produktionen);
pinMode (motorPin3, produktionen);
pinMode (motorPin4, produktionen);
}
void stop() {
digitalWrite (motorPin, låg);
digitalWrite (motorPin2, låg);
digitalWrite (motorPin3, låg);
digitalWrite (motorPin4, låg);
}
void forward() {
digitalWrite (motorPin, hög);
digitalWrite (motorPin2, hög);
digitalWrite (motorPin3, låg);
digitalWrite (motorPin4, låg);
}
void backward() {
digitalWrite (motorPin, låg);
digitalWrite (motorPin2, låg);
digitalWrite (motorPin3, hög);
digitalWrite (motorPin4, hög);
}
void turnLeft() {
digitalWrite (motorPin, hög);
digitalWrite (motorPin2, låg);
digitalWrite (motorPin3, låg);
digitalWrite (motorPin4, hög);
}
void turnRight() {
digitalWrite (motorPin, låg);
digitalWrite (motorPin2, hög);
digitalWrite (motorPin3, hög);
digitalWrite (motorPin4, låg);
}
void loop() {
om (BT.available() > 0) {
kommandot = BT.read();
Växla (kommandot) {
fallet "w":
Forward();
bryta;
fallet "x":
Backward();
bryta;
fallet "a":
turnLeft();
bryta;
fall skulle ":
turnRight();
bryta;
fallet ":
Stop();
bryta;
}
}
}
Ladda upp denna kod till Arduino först innan du flyttar till nästa steg.