12-11-2019, 02:40 AM
Llevo horas tratando de resolver este problema, pero no encuentro una solución... Este es mi código:
#include <AFMotor.h>
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
AF_DCMotor motor3(3);
AF_DCMotor motor4(4);
#include <SoftwareSerial.h>
SoftwareSerial BT1(4,2);
char s='l';
void setup() {
// put your setup code here, to run once:
Serial.begin(9600);
BT1.begin(9600);
motor2.setSpeed(250);
motor3.setSpeed(250);
motor4.setSpeed(250);
}
void loop() {
// put your main code here, to run repeatedly:
BT1.println("Listo");
if(BT1.available()){
s=BT1.read();
Serial.println(s);
}
delay (1000);
if(s=='a'){ //Adelante
motor1.run(FORWARD);
motor2.run(FORWARD);
motor3.run(FORWARD);
motor4.run(FORWARD);
motor1.setSpeed(240);
motor2 .setSpeed(240);
motor3.setSpeed(240);
motor4.setSpeed(240);
}
if(s=='t'){ //Atrás
motor1.run(BACKWARD);
motor2.run(BACKWARD);
motor3.run(BACKWARD);
motor4.run(BACKWARD);
}
if(s=='i'){ //Vuelta a la izquierda
motor1.run(FORWARD);
motor2.run(FORWARD);
motor3.run(RELEASE);
motor4.run(RELEASE);
}
if(s=='d'){ //Vuelta a la derecha
motor1.run(RELEASE);
motor2.run(RELEASE);
motor3.run(FORWARD);
motor4.run(FORWARD);
}
if(s=='r'){ //Detener
motor1.run(RELEASE);
motor2.run(RELEASE);
motor3.run(RELEASE);
motor4.run(RELEASE);
}
}
#include <AFMotor.h>
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
AF_DCMotor motor3(3);
AF_DCMotor motor4(4);
#include <SoftwareSerial.h>
SoftwareSerial BT1(4,2);
char s='l';
void setup() {
// put your setup code here, to run once:
Serial.begin(9600);
BT1.begin(9600);
motor2.setSpeed(250);
motor3.setSpeed(250);
motor4.setSpeed(250);
}
void loop() {
// put your main code here, to run repeatedly:
BT1.println("Listo");
if(BT1.available()){
s=BT1.read();
Serial.println(s);
}
delay (1000);
if(s=='a'){ //Adelante
motor1.run(FORWARD);
motor2.run(FORWARD);
motor3.run(FORWARD);
motor4.run(FORWARD);
motor1.setSpeed(240);
motor2 .setSpeed(240);
motor3.setSpeed(240);
motor4.setSpeed(240);
}
if(s=='t'){ //Atrás
motor1.run(BACKWARD);
motor2.run(BACKWARD);
motor3.run(BACKWARD);
motor4.run(BACKWARD);
}
if(s=='i'){ //Vuelta a la izquierda
motor1.run(FORWARD);
motor2.run(FORWARD);
motor3.run(RELEASE);
motor4.run(RELEASE);
}
if(s=='d'){ //Vuelta a la derecha
motor1.run(RELEASE);
motor2.run(RELEASE);
motor3.run(FORWARD);
motor4.run(FORWARD);
}
if(s=='r'){ //Detener
motor1.run(RELEASE);
motor2.run(RELEASE);
motor3.run(RELEASE);
motor4.run(RELEASE);
}
}