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

#include <Servo.h>

Servo servo;

int piezoPin = 11;

int echoPin = 3;

int trigPin = 2;

int servoPin = 9;

unsigned long currentTime = 0;

boolean flag = 0;

int checkTime = 500;

int pushAngle = 10;

int currentAngle = 90;

void setup() {

  servo.attach(servoPin);

  servo.write(currentAngle);

  delay(100);

  servo.detach();

  pinMode(trigPin, OUTPUT);

  pinMode(echoPin, INPUT);

  pinMode(piezoPin, OUTPUT);

}

void loop() {

  digitalWrite(trigPin, LOW);

  digitalWrite(echoPin, LOW);

  delayMicroseconds(2);

  digitalWrite(trigPin, HIGH);

  delayMicroseconds(10);

  digitalWrite(trigPin, LOW);

  unsigned long duration = pulseIn(echoPin, HIGH);

  float distance = duration / 29.0 / 2.0;

  if (distance <= 10) {

    if (flag == 0) {

      currentTime = millis();

      flag = 1;

    }

    if (millis() >= currentTime + checkTime) {

      servo.attach(servoPin);

      tone(piezoPin, 1046, 200);

      delay(200);

      tone(piezoPin, 1175, 200);

      delay(200);

      tone(piezoPin, 1319, 200);

      delay(800);

      servo.write(pushAngle);

      delay(1000);

      servo.write(currentAngle);

      delay(1000);

      servo.detach();

      flag = 0;

    }

  }

  else {

    flag = 0;

    noTone(piezoPin);

  }

  delay(100);

}