Advertisement
Guest User

Pi In The Sky 4 Sonar Sensors on Pi

a guest
Feb 7th, 2016
74
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.38 KB | None | 0 0
  1. import RPi.GPIO as GPIO
  2. import time
  3. GPIO.setmode(GPIO.BCM)
  4.  
  5. TRIG = 23
  6. ECHO = 24
  7.  
  8. print "Distance Measurement 1 In Progress"
  9.  
  10. GPIO.setup(TRIG,GPIO.OUT)
  11. GPIO.setup(ECHO,GPIO.IN)
  12.  
  13. GPIO.output(TRIG, False)
  14. print "Waiting For Sensor 1 To Settle"
  15. time.sleep(0.5)
  16.  
  17. GPIO.output(TRIG, True)
  18. time.sleep(0.00001)
  19. GPIO.output(TRIG, False)
  20.  
  21. while GPIO.input(ECHO)==0:
  22. pulse_start = time.time()
  23.  
  24. while GPIO.input(ECHO)==1:
  25. pulse_end = time.time()
  26.  
  27. pulse_duration = pulse_end - pulse_start
  28.  
  29. distance = pulse_duration * 17150
  30.  
  31. distance = round(distance, 2)
  32.  
  33. print "Distance:",distance,"cm"
  34.  
  35.  
  36. ##################################################
  37. TRIG2 = 02
  38. ECHO2 = 03
  39.  
  40. print "Distance Measurement 2 In Progress"
  41.  
  42. GPIO.setup(TRIG2,GPIO.OUT)
  43. GPIO.setup(ECHO2,GPIO.IN)
  44.  
  45. GPIO.output(TRIG2, False)
  46. print "Waiting For Sensor 2 To Settle"
  47. time.sleep(0.5)
  48.  
  49. GPIO.output(TRIG2, True)
  50. time.sleep(0.00001)
  51. GPIO.output(TRIG2, False)
  52.  
  53. while GPIO.input(ECHO2)==0:
  54. pulse_start = time.time()
  55.  
  56. while GPIO.input(ECHO2)==1:
  57. pulse_end = time.time()
  58.  
  59. pulse_duration = pulse_end - pulse_start
  60.  
  61. distance = pulse_duration * 17150
  62.  
  63. distance = round(distance, 2)
  64.  
  65. print "Distance:",distance,"cm"
  66.  
  67.  
  68. ###################################
  69.  
  70. TRIG3 = 14
  71. ECHO3 = 15
  72.  
  73. print "Distance Measurement 3 In Progress"
  74.  
  75. GPIO.setup(TRIG3,GPIO.OUT)
  76. GPIO.setup(ECHO3,GPIO.IN)
  77.  
  78. GPIO.output(TRIG3, False)
  79. print "Waiting For Sensor 3 To Settle"
  80. time.sleep(0.5)
  81.  
  82. GPIO.output(TRIG3, True)
  83. time.sleep(0.00001)
  84. GPIO.output(TRIG3, False)
  85.  
  86. while GPIO.input(ECHO3)==0:
  87. pulse_start = time.time()
  88.  
  89. while GPIO.input(ECHO3)==1:
  90. pulse_end = time.time()
  91.  
  92. pulse_duration = pulse_end - pulse_start
  93.  
  94. distance = pulse_duration * 17150
  95.  
  96. distance = round(distance, 2)
  97.  
  98. print "Distance:",distance,"cm"
  99.  
  100.  
  101. ##############################
  102. TRIG4 = 25
  103. ECHO4 = 8
  104.  
  105.  
  106. print "Distance Measurement 4 In Progress"
  107.  
  108. GPIO.setup(TRIG4,GPIO.OUT)
  109. GPIO.setup(ECHO4,GPIO.IN)
  110.  
  111. GPIO.output(TRIG4, False)
  112. print "Waiting For Sensor 4 To Settle"
  113. time.sleep(0.5)
  114.  
  115. GPIO.output(TRIG4, True)
  116. time.sleep(0.00001)
  117. GPIO.output(TRIG4, False)
  118.  
  119. while GPIO.input(ECHO4)==0:
  120. pulse_start = time.time()
  121.  
  122. while GPIO.input(ECHO4)==1:
  123. pulse_end = time.time()
  124.  
  125. pulse_duration = pulse_end - pulse_start
  126.  
  127. distance = pulse_duration * 17150
  128.  
  129. distance = round(distance, 2)
  130.  
  131. print "Distance:",distance,"cm"
  132. GPIO.cleanup()
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement