Mano robot
Enviado por Colin9999 • 28 de Febrero de 2016 • Tutorial • 661 Palabras (3 Páginas) • 272 Visitas
//Programacion para crear una mano robotica, en este caso una mano derecha. Codigo creado por ---> Jose Angel Colin Najera <----- Basado en el libro ''30 Proyectos con arduino''
#include <Servo.h> // Incluir Servomotor
Servo servo1; // Servo Motor 1
Servo servo2; // Servo Motor 2
Servo servo3; // Servo Motor 3
Servo servo4; // Servo Motor 4
Servo servo5; // Servo Motor 5
int estado; // Incluir el estado 'estado'
void setup()
{
servo1.attach(3); //Dedo Meñique
servo2.attach(4); //Dedo Anular
servo3.attach(5); //Dedo Medio/Corazon
servo4.attach(6); //Dedo Indice
servo5.attach(7); //Dedo Pulgar
pinMode(9,OUTPUT);
pinMode(10,OUTPUT);
pinMode(11,OUTPUT);
pinMode(12,OUTPUT);
pinMode(13,OUTPUT);
Serial.begin(9600);
}
void loop(){
if(Serial.available()>0){
estado = Serial.read();
}
if (estado == '1'){ // Si estado es igual a '1' el servo.1(Meñique) se activara y se encendera un Led indicador situado en el pin 9 del Arduino
servo1.write(180);
digitalWrite(9, HIGH);
}
if (estado == '2'){ // Si estado es igual a '2' el servo.1(Meñique) se desactivara y se apagara un Led indicador situado en el pin 9 del Arduino
servo1.write(0);
digitalWrite(9, LOW);
} //<---------Fin del dedo Meñique
if (estado == '3'){ // Si estado es igual a '3' el servo.2(Anular) se activara y se encendera un Led indicador situado en el pin 10 del Arduino
servo2.write(180);
digitalWrite(10, HIGH);
}
if (estado == '4'){ // Si estado es igual a '4' el servo.2(Anular) se desactivara y se apagara un Led indicador situado en el pin 10 del Arduino
servo2.write(0);
digitalWrite(10, LOW);
} //<-------Fin del dedo Anular
if (estado == '5'){ // Si estado es igual a '5' el servo.3(Medio/Corazon) se activara y se encendera un Led indicador situado en el pin 11 del Arduino
servo3.write(180);
digitalWrite(11, HIGH);
}
if (estado == '6'){ // Si estado es igual a '6' el servo.3(Medio/Corazon) se desactivara y se apagara un Led indicador situado en el pin 11 del Arduino
servo3.write(0);
digitalWrite(11, LOW);
} //<---------Fin del dedo Meñique
if (estado == '7'){ // Si estado es igual a '7' el servo.4(Indice) se activara y se encendera un Led indicador situado en el pin 12 del Arduino
servo4.write(180);
...