import RPi.GPIO as GPIO
import time
GPIO.setmode(GPIO.BCM)
trig=5
echo=6
GPIO.setup(trig,GPIO.OUT,initial=GPIO.LOW)
GPIO.setup(echo,GPIO.IN)
def Measure():
GPIO.output(trig,True)
time.sleep(0.00001)
GPIO.output(trig,False)
while GPIO.input(echo)==0:
pass
start=time.time()
while GPIO.input(echo)==1:
pass
end=time.time()
distance=round((end-start)*343/2*100,2)
print("distance:{0}cm,{1}m".format(distance,distance/100))
while True:
Measure()
time.sleep(1)
GPIO.cleanup();
import RPi.GPIO as GPIO
import time
ENB = 21
ENA = 5
IN1 = 19
IN2 = 26
IN3 = 13
IN4 = 6
if __name__ == '__main__':
try:
GPIO.setmode(GPIO.BCM)
GPIO.setup(ENA, GPIO.OUT)
GPIO.setup(IN1, GPIO.OUT)
GPIO.setup(IN2, GPIO.OUT)
GPIO.setup(ENB, GPIO.OUT)
GPIO.setup(IN3, GPIO.OUT)
GPIO.setup(IN4, GPIO.OUT)
while True:
GPIO.output(IN1, False)
GPIO.output(IN2, True)
GPIO.output(ENA, True)
GPIO.output(IN3, False)
GPIO.output(IN4, True)
GPIO.output(ENB, True)
time.sleep(2)
GPIO.output(ENA, False)
GPIO.output(ENB, False)
time.sleep(1)
GPIO.output(IN1, True)
GPIO.output(IN2, False)
GPIO.output(ENA, True)
GPIO.output(IN3, True)
GPIO.output(IN4, False)
GPIO.output(ENB, True)
time.sleep(2)
GPIO.output(ENA, False)
GPIO.output(ENB, False)
time.sleep(1)
finally:
pwm.stop()
GPIO.cleanup()