Adafruit Motor sköld & Funduino (4 / 6 steg)

Steg 4: Ladda upp skiss för Bluetooth

#include < AFMotor.h >

char val; Variabel för att ta emot data från den seriella porten

DC-motor på M1
AF_DCMotor motor(1);

DC-motor på M2
AF_DCMotor motor2(2);

int i;

void setup() {
Serial.BEGIN(115200);

slå på motor #1
motor.setSpeed(200);
motor.Run(release);

slå på motor #2
motor2.setSpeed(200);
motor2.Run(release);
}

Gå framåt
void go_forward() {

motor.Run(forward);
motor2.Run(forward);

för (jag = 0; jag < 255; i ++) {
motor.setSpeed(i);
motor2.setSpeed(i);
}
}
Flytta bakåt
void go_reverse() {

motor.Run(Backward);
motor2.Run(Backward);

för (jag = 0; jag < 255; i ++) {
motor.setSpeed(i);
motor2.setSpeed(i);
}
}
Flytta vänster
void go_left() {

motor.Run(forward);
för (jag = 0; jag < 255; i ++) {
motor.setSpeed(i);
}
}
Flytta höger
void go_right() {

motor2.Run(forward);
för (jag = 0; jag < 255; i ++) {
motor2.setSpeed(i);
}
}

Läs seriell port och utföra kommandot
void performCommand() {
om (Serial.available()) {
Val = Serial.read();
}
om (val == "f") {/ / framåt
go_forward();
} else om (val == "z") {/ / stoppa fram
stop_go_forward();
} else om (val == 'b') {/ / back
go_reverse();
} else om (val == "y") {/ / sluta vända
stop_go_reverse();
} else om (val == "l") {/ / höger
go_right();
} else om (val == "r") {/ / vänster
go_left();
} else om (val == 't') {/ / stoppa bilen med turbofunktion
stop_car();
}

}
void loop() {
performCommand();

}

kod slutar här