Added sensor test file

iotify · Nov 19, 2016 · 19f055d · 19f055d
1 parent 1111fbe
commit 19f055d
Showing 1 changed file with 35 additions and 0 deletions.
diff --git a/hcsr04-test.py b/hcsr04-test.py
@@ -0,0 +1,35 @@
+import RPi.GPIO as GPIO
+import time
+GPIO.setmode(GPIO.BCM)
+
+TRIG = 5 
+ECHO = 6
+
+print "Measuring Distance"
+
+GPIO.setup(TRIG,GPIO.OUT)
+GPIO.setup(ECHO,GPIO.IN)
+
+GPIO.output(TRIG, False)
+print "Waiting For Sensor"
+time.sleep(2)
+
+GPIO.output(TRIG, True)
+time.sleep(0.00001)
+GPIO.output(TRIG, False)
+
+while GPIO.input(ECHO)==0:
+  pulse_start = time.time()
+
+while GPIO.input(ECHO)==1:
+  pulse_end = time.time()
+
+pulse_duration = pulse_end - pulse_start
+
+distance = pulse_duration * 17150
+
+distance = round(distance, 2)
+
+print "Distance:",distance,"cm"
+
+GPIO.cleanup()