Create HC-SR04.ino

NikodemBartnik · May 19, 2018 · f04362d · f04362d
1 parent eb873b5
commit f04362d
Showing 1 changed file with 22 additions and 0 deletions.
diff --git a/HC-SR04/HC-SR04.ino b/HC-SR04/HC-SR04.ino
@@ -0,0 +1,22 @@
+#define TRIG 2
+#define ECHO 3
+
+void setup() {
+  Serial.begin(9600);
+  pinMode(TRIG, OUTPUT);
+  pinMode(ECHO, INPUT);
+}
+
+void loop() {
+  digitalWrite(TRIG, LOW);
+  delayMicroseconds(2);
+  digitalWrite(TRIG, HIGH);
+  delayMicroseconds(5);
+  digitalWrite(TRIG, LOW);
+
+  float t = pulseIn(ECHO, HIGH);
+  float distance = t*0.017015;
+  Serial.print("Distance: ");
+  Serial.println(distance);
+  delay(500);
+}