SENSOR ULTRASÓNICO Y SERVOMOTOR. BARRERA DE PARKING.

 #include <Servo.h>

Servo servo;
int trigPin=7;
int echoPin=6;
void setup(){
  servo.attach(9);
  pinMode(trigPin,OUTPUT);
  pinMode(echoPin,INPUT);
  Serial.begin(9600);
  servo.write(0);
}
void loop(){
  long duracion,distancia;
  digitalWrite(trigPin,LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin,HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin,LOW);
  duracion=pulseIn(echoPin,HIGH);
  distancia=duracion*0.034/2;
  Serial.print(distancia);
  Serial.println("cm");
  delay(500);
  if(distancia<20){
    servo.write(90);
    delay(4000);
    servo.write(0);
   
  }
}

No hay comentarios:

Publicar un comentario