CTB

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);
  }
}