Esquema
A continuación mostramos el esquema en fritzing.
Código Arduino
Nota:Cuando subas el programa debes de desconectar el modulo HC-06 para que no tengas problemas:
#include <SoftwareSerial.h>
#include<Servo.h>
Servo m; //Dedo medio
Servo p; //Dedo indice o servo2 izquierda a derecha
Servo i; //Dedo índice
//Servo a; //dedo anular
Servo p1; //Dedo pulgar falange
Servo am; //Dedos anular y meñique
SoftwareSerial BT(0,1);
String readdata;
char c;
void setup() {
// put your setup code here, to run once:
BT.begin(9600);
Serial.begin(9600);
// Pinees de señal de cada dedo
p1.attach(8);
p.attach(9);
i.attach(13);
//a.attach(11);
m.attach(11);
am.attach(12);
readdata.reserve(200);
}
void loop() {
// put your main code here, to run repeatedly:
while (BT.available()) {
c=BT.read();
if(c == '1'){
p1.write(45);
delay(4000);
p1.write(180);
}
if(c == '2'){
p.write(180);
delay(4000);
p.write(0);
}
if(c == '3'){
m.write(180);
delay(4000);
m.write(0);
}
if(c == '4'){
am.write(180);
delay(4000);
am.write(0);
}
if(c == '5'){
i.write(180);
delay(4000);
i.write(0);
}
//Mano abierta
if(c == 'a'){
p1.write(180);
p.write(0);
i.write(0);
m.write(0);
am.write(0);
}
//Mano cerrada
if(c == 'b'){
p1.write(45);
p.write(180);
i.write(180);
m.write(180);
am.write(180);
}
//Amor y paz
if(c == 'c'){
p1.write(45);
p.write(180);
i.write(0);
m.write(0);
am.write(180);
}
//OK
if(c == 'd'){
p1.write(180);
p.write(180);
i.write(0);
m.write(180);
am.write(180);
}
//OK2
if(c == 'e'){
p1.write(45);
p.write(90);
i.write(180);
m.write(0);
am.write(0);
}
}c="";
}