손소독제 펌핑장치 만들기2

#include <Servo.h>

const int trig_pin=11;

const int echo_pin=12;

const int servoPin=10;

Servo myservo;

int pushAngle = 10;

int currentAngle = 90;

void setup() {

  myservo.attach(servoPin);

  myservo.write(currentAngle);

  delay(100);

  myservo.detach();

  pinMode(trig_pin, OUTPUT);

  pinMode(echo_pin, INPUT);

  Serial.begin(9600);

}

void loop() {

  digitalWrite(trig_pin,LOW);

  delayMicroseconds(2);

  digitalWrite(trig_pin,HIGH);

  delayMicroseconds(10);

  digitalWrite(trig_pin,LOW);

  long duration=pulseIn(echo_pin,HIGH);

  long distance=(duration/2)/29.1;

  Serial.print(distance);

  Serial.println("cm"); 

  if (distance <= 10) {

      myservo.attach(servoPin);

      myservo.write(pushAngle);

      delay(1000);

      myservo.write(currentAngle);

      delay(3000);

      myservo.detach();

    }

  delay(100);

}