Muy buenas,
Se que es un tema muy aclamado en este foro pero ninguno de los posts anteriores han conseguido solucionar mi problema.
Mi proyecto consta de un coche que deberia de poderse controlar desde un dispositivo movil con, a parte de las funciones basicas de abanzar, retroceder y girar en ambas soluciones, utilitza un sensor de ultrasonidos además de un mini servo motor de 9g.
A la hora de intentar conectar mi dispositivo al módulo BT este se conecta sin problema aunque a los pocos segundos se desconecta. En ningun momento el led del módulo parpadea de manera distinta, sigue parpadeando rapido y constante.
#include <Servo.h> //Llibreria per poder controlar el servo
#include <NewPing.h> //Llibreria per controlar més fàcilment les funcions del sensor
//motors connectats a arduino
int LeftA = 3; // Motor esquerra endavant
int LeftB = 4; // Motor esquerra enrere
int RightA = 5; // Motor dret endavant
int RightB = 6; // Motor dret enrere
// Pins del sensor d'ultrasons
int echo = 9;
int trig = 8;
int servo = 12; //Pin vinculat al servo
#define trig_pin 8 //Definim els pins per al HC-SR04
#define echo_pin 9
#define maximum_distance 200
//boolean goForward = false;
int distance = 100;
NewPing sonar(trig_pin, echo_pin, maximum_distance);//funcions del sensor d'ultrasons
Servo servoMotor; // Declarem la variable per controlar el servo
char t;
void setup() {
pinMode(RightA, OUTPUT); //Definim els pins dels motors com a sortides
pinMode(RightB, OUTPUT);
pinMode(LeftA, OUTPUT);
pinMode(LeftB, OUTPUT);
pinMode(echo, INPUT); //Definim pin echo del HC-SR04 com a entrada
pinMode(trig, OUTPUT); //Definim pin trig del HC-SR04 com a sortida
Serial.begin(9600); //Inicia per comunicar-se amb el mòdul Bluetooh
}
void loop(){
if (Serial.available()>0) { // Si el Bluetooth esta encès inicia comunicació
t = Serial.read();
Serial.println(t);
}
if (t == 'F') { //Moure endavant, els dos motors encesos cap endevant
Forward();
}
else if (t == 'B') { //Moure enrere, els dos motors encesos en reversa
Back();
}
else if (t == 'R') { //Girar a la dreta, motor esquerra rota endavant i motor esquerre no es mou
Right();
}
else if (t == 'L') { //Girar a l'esquerra, motor dret rota endavant
Left();
}
else if (t == 'S') { //Tots els motors s'aturen.
Stop();
}
}
void Stop() { //Acció de parar
digitalWrite(LeftA, LOW);
digitalWrite(LeftB, LOW);
digitalWrite(RightA, LOW);
digitalWrite(RightB, LOW);
}
void Forward() { //Acció d'avançar
//if (!goForward) { //definim les funcions de la variable goForward per a que desideixi si ha d'avançar o no
//goForward = true;
digitalWrite(LeftA, HIGH);
digitalWrite(LeftB, LOW);
digitalWrite(RightA, HIGH);
digitalWrite(RightB, LOW);
//}
}
int Back() { //Acció de retrocedir
// goForward = false;
digitalWrite(RightB, HIGH);
digitalWrite(LeftB, HIGH);
digitalWrite(RightA, LOW);
digitalWrite(LeftA, LOW);
}
void Right() { //Acció de girar a la dreta
digitalWrite(LeftA, HIGH);
digitalWrite(RightB, HIGH);
digitalWrite(LeftB, LOW);
digitalWrite(RightA, LOW);
delay(500);
digitalWrite(LeftA, HIGH);
digitalWrite(RightA, HIGH);
digitalWrite(LeftB, LOW);
digitalWrite(RightB, LOW);
}
void Left() { //Acció de girar a l'esquerra
digitalWrite(LeftB, HIGH);
digitalWrite(RightA, HIGH);
digitalWrite(LeftA, LOW);
digitalWrite(RightB, LOW);
delay(500);
digitalWrite(LeftA, HIGH);
digitalWrite(RightA, HIGH);
digitalWrite(LeftB, LOW);
digitalWrite(RightB, LOW);
}
El codigo no me da ningun error y tambien adjunto el esquema del proyecto, porfavor si alguien encuentra un error en el codigo o una solución, aunque no sea sobre el BT se lo agradeceria.
Los mensajes de la derecha para aclarar cada una de las funciones estan en catalán, espero que no sea molestia para poder entendelo todo, xD.
Muchas gracias
