//13 luz verde

//11 luz roja

#define trigPin 12

#define echoPin 8

#include <Servo.h>

Servo ROBO;//bautizo mi motor

int posicion;

#define led 13

#define LED 11

void setup(){

   ROBO.attach(9);

 pinMode(trigPin, OUTPUT);

 pinMode(echoPin, INPUT);

  Serial.begin(9600);

ROBO.write(0);

pinMode(LED, OUTPUT);

pinMode(led, OUTPUT);

}

 void loop()  

{

  long duracion, distancia ;

  digitalWrite(trigPin, LOW);      

  delayMicroseconds(2);          

  digitalWrite(trigPin, HIGH);                

  delayMicroseconds(10);            

  digitalWrite(trigPin, LOW);      

  duracion = pulseIn(echoPin, HIGH) ;

  distancia = duracion / 2 / 29.1  ;

  Serial.println(String(distancia) + " cm.") ;

  int Limite = 20 ;                  // Medida en vacío del sensor

delay(3000);

if ((distancia<15)&&(distancia>0)&&(posicion==0)){

  Serial.println("distancia entre 15 y 0"); 

  

  for (posicion=0;posicion<90;posicion++){//lo mando del 0 a 90 grados de 1 n 1

      ROBO.write(posicion);

      delay(110);}//hago que tarde 110 mseg

  digitalWrite(13, HIGH);

  digitalWrite(11, LOW);

  

}

if ((distancia>15)&&(posicion==90)){

  Serial.println("distancia mayor que 15");

  for (posicion=90;posicion>0;posicion--){//lo mando del 0 a 90 grados de 1 n 1

  ROBO.write(posicion);

  delay(110);//hago que tarde 110 mseg

   digitalWrite(13, LOW);

  digitalWrite(11, HIGH);

}

//ROBO.write(posicion);

}

}