자동펌핑

-학습목표-

자동펌핑 손세정제를 역공학을 이용해 분석하고 실현, 평가할 수 있다.

장치를 만들기 위해 필요한 지식은 무엇이 있을까요?

/*

* 스위치 없이, 초음파센서 가까이 갈 경우 소독제 작동

*/

#include <Servo.h>

Servo myservo;

int first_angle = 50;

int second_angle = 255;

int detection_distance = 20; //(cm)you can change the value.

int echoPin = 6; //ultrasonic sensor echoPIN

int trigPin = 5; //ultrasonic sensor trigPIN

void setup() {

Serial.begin(9600);

myservo.attach(3);

myservo.write(first_angle);

pinMode(sw, INPUT_PULLUP);

pinMode(trigPin, OUTPUT);

pinMode(echoPin, INPUT);

}

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;

Serial.println(distance);

if (distance <= detection_distance){

myservo.write(second_angle);

delay(400);

myservo.write(first_angle);

delay(800);

}

else{

myservo.write(first_angle);

}

}