自動噴酒精機器

Arduino 超音波

int trigPin = 12;
int echoPin = 11;
long duration, cm, inches;

void setup() {

Serial.begin (9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(13, OUTPUT);
digitalWrite(13,LOW);

}

void loop()
{
digitalWrite(trigPin, LOW);
delayMicroseconds(5);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);

pinMode(echoPin, INPUT);
duration = pulseIn(echoPin, HIGH);

cm = (duration/2) / 29.1;
Serial.print("Distance :");

Serial.print(cm);
Serial.print("c");
Serial.println();
if (cm <= 6) {
digitalWrite(13,HIGH);

} else {

digitalWrite(13,LOW);

}

}