스마트휴지통만들기

#include  <Servo.h>

Servo myservo; 

int pos = 10;

int trigPin = 2; 

int echoPin = 3;   

float duration;

float distance = 100;

void setup() {

  myservo.attach(9);

  pinMode(trigPin, OUTPUT);

  pinMode(echoPin, INPUT);  

  Serial.begin(9600);

}

void loop() {

  digitalWrite(trigPin, LOW);

  delay(2);

  digitalWrite(trigPin, HIGH); 

  delay(10);

  digitalWrite(trigPin, LOW);

  duration = pulseIn(echoPin, HIGH);

  distance = ((float)(340 * duration) / 10000) / 2;   

  if (distance < 20){       

    for (pos = 10; pos < 120; pos += 2)

    {Serial.print(distance);

   Serial.println("cm");

      myservo.write(pos);

      delay(10);

    }

    delay(5000); 

    for (pos = 120; pos >= 10; pos -= 5){

      myservo.write(pos);

      delay(10);

    }

  }

  delay(50);

}