Código de arduino
#include <Servo.h>
Servo base;
Servo codo;
Servo muneca;
int pos = 0;
int lmotorpin1=5;
int lmotorpin2=6;
int rmotorpin1=10;
int rmotorpin2=11;
int sensor=2;
int sensorstate=0;
void setup(){
pinMode(sensor,INPUT);
pinMode(lmotorpin1,OUTPUT);
pinMode(lmotorpin2,OUTPUT);
pinMode(rmotorpin1,OUTPUT);
pinMode(rmotorpin2,OUTPUT);
base.attach(3);
codo.attach(6);
muneca.attach(9);
}
void loop(){
sensorstate=digitalRead(sensor);
if(sensorstate==HIGH){
digitalWrite(lmotorpin1,LOW);
digitalWrite(lmotorpin2,LOW);
digitalWrite(rmotorpin1,LOW);
digitalWrite(rmotorpin2,LOW);
delay (1000);
base.write(10);
delay(1500);
codo.write(0);
delay(1000);
muneca.write(160);
delay(1000);
codo.write(30);
delay(1000);
base.write(180);
delay(1500);
codo.write(0);
delay(1000);
muneca.write(30);
delay(1000);
}
else{
digitalWrite(rmotorpin1,HIGH);
digitalWrite(rmotorpin2,HIGH);
digitalWrite(lmotorpin1,HIGH);
digitalWrite(lmotorpin2,HIGH);
}
}
#include <Servo.h>
Servo base;
Servo codo;
Servo muneca;
int pos = 0;
int lmotorpin1=5;
int lmotorpin2=6;
int rmotorpin1=10;
int rmotorpin2=11;
int sensor=2;
int sensorstate=0;
void setup(){
pinMode(sensor,INPUT);
pinMode(lmotorpin1,OUTPUT);
pinMode(lmotorpin2,OUTPUT);
pinMode(rmotorpin1,OUTPUT);
pinMode(rmotorpin2,OUTPUT);
base.attach(3);
codo.attach(6);
muneca.attach(9);
}
void loop(){
sensorstate=digitalRead(sensor);
if(sensorstate==HIGH){
digitalWrite(lmotorpin1,LOW);
digitalWrite(lmotorpin2,LOW);
digitalWrite(rmotorpin1,LOW);
digitalWrite(rmotorpin2,LOW);
delay (1000);
base.write(10);
delay(1500);
codo.write(0);
delay(1000);
muneca.write(160);
delay(1000);
codo.write(30);
delay(1000);
base.write(180);
delay(1500);
codo.write(0);
delay(1000);
muneca.write(30);
delay(1000);
}
else{
digitalWrite(rmotorpin1,HIGH);
digitalWrite(rmotorpin2,HIGH);
digitalWrite(lmotorpin1,HIGH);
digitalWrite(lmotorpin2,HIGH);
}
}
Comentarios
Publicar un comentario