programacion arduino 2

 // Incluímos la librería para poder controlar el servo

#include <Servo.h>

 

// Declaramos la variable para controlar el servo

Servo servocabeza;

Servo servobraiz;

Servo servobrade;

Servo servocadera;

const int pinecho = 8;

const int pintrigger = 7;

unsigned int tiempo, distancia;

 

void setup() {

  // Iniciamos el monitor serie para mostrar el resultado

  Serial.begin(9600);

 

  // Iniciamos el servo para que empiece a trabajar con el pin 9

  servocabeza.attach(9);  

  servobrade.attach(6);  

  servobraiz.attach(5);  

  servocadera.attach(3);

pinMode(pintrigger, OUTPUT); //salida del pulso generado por el sensor ultrasónico

pinMode(pinecho, INPUT);//entrada del pulso generado por el sensor ultrasónico

}

 

void loop() {

  //CABEZA

  // Desplazamos a la posición 0º

  servocabeza.write(0);

 

  // Esperamos 1 segundo

  delay(1000);

  

  // Desplazamos a la posición 90º

  servocabeza.write(90);

  // Esperamos 1 segundo

  delay(1000);

  

  // Desplazamos a la posición 180º

  servocabeza.write(180);

  // Esperamos 1 segundo

  delay(1000);

    

    //BRAZO IZQUIERDO

    // Desplazamos a la posición 180º

  servobraiz.write(180);

  servobrade.write(0);

 

  // Esperamos 1 segundo

  delay(1000);

  

  // Desplazamos a la posición 90º

  servobraiz.write(90);

  servobrade.write(90);

  // Esperamos 1 segundo

  delay(1000);

  

  // Desplazamos a la posición 0º

  servobraiz.write(0);

  servobrade.write(180);

  // Esperamos 1 segundo

  delay(1000);

    

    //CADERA

    // Desplazamos a la posición 0º

  servocadera.write(0);

 

  // Esperamos 1 segundo

  delay(1000);

  

  // Desplazamos a la posición 90º

  servocadera.write(90);

  // Esperamos 1 segundo

  delay(1000);

  

  // Desplazamos a la posición 180º

  servocadera.write(180);

  // Esperamos 1 segundo

  delay(1000);

}