#define IN1 6
#define IN2 7
#define IN3 8
#define IN4 9
#define trigPin 10
#define echoPin 11
char comando;
void setup() {
Serial.begin(9600);
pinMode(IN1, OUTPUT);
pinMode(IN2, OUTPUT);
pinMode(IN3, OUTPUT);
pinMode(IN4, OUTPUT);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
}
void loop() {
if (Serial.available()) {
comando = Serial.read();
controlaMotores(comando);
}
long distancia = medirDistancia();
if (distancia < 20) {
parar();
}
}
void controlaMotores(char c) {
switch (c) {
case 'F': // Frente
frente();
break;
case 'B': // Trás
tras();
break;
case 'L': // Esquerda
esquerda();
break;
case 'R': // Direita
direita();
break;
case 'S': // Parar
parar();
break;
}