Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #!/usr/bin/python
- #+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- #|R|a|s|p|b|e|r|r|y|P|i|-|S|p|y|.|c|o|.|u|k|
- #+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
- #
- # ultrasonic_1.py
- # Measure distance using an ultrasonic module
- #
- # Author : Matt Hawkins
- # Date : 09/01/2013
- #
- # Edit by : Wilds
- # Date : 17/06/2014
- # Import required Python libraries
- import time
- import RPi.GPIO as GPIO
- import sys
- # Use BCM GPIO references
- # instead of physical pin numbers
- GPIO.setmode(GPIO.BCM)
- # Define GPIO to use on Pi
- GPIO_TRIGGER = 23
- GPIO_ECHO = 24
- print "Ultrasonic Measurement"
- # Set pins as output and input
- GPIO.setup(GPIO_TRIGGER,GPIO.OUT) # Trigger
- GPIO.setup(GPIO_ECHO,GPIO.IN) # Echo
- # Set trigger to False (Low)
- GPIO.output(GPIO_TRIGGER, False)
- # Allow module to settle
- time.sleep(0.5)
- try:
- while True:
- # Send 10us pulse to trigger
- GPIO.output(GPIO_TRIGGER, True)
- time.sleep(0.00001)
- GPIO.output(GPIO_TRIGGER, False)
- start = time.time()
- while GPIO.input(GPIO_ECHO)==0:
- start = time.time()
- while GPIO.input(GPIO_ECHO)==1:
- stop = time.time()
- # Calculate pulse length
- elapsed = stop-start
- # Distance pulse travelled in that time is time
- # multiplied by the speed of sound (cm/s)
- distance = elapsed * 34000
- # That was the distance there and back so halve the value
- distance = distance / 2
- #print "Distance : %.1f" % distance
- sys.stdout.write("\rDistance : %.1f " % distance)
- sys.stdout.flush()
- time.sleep(0.1)
- except KeyboardInterrupt:
- print()
- # Reset GPIO settings
- GPIO.cleanup()
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement