初始化提交
This commit is contained in:
27
boards/default/micropython_k210_mixgoai/build/lib/hcr04.py
Normal file
27
boards/default/micropython_k210_mixgoai/build/lib/hcr04.py
Normal file
@@ -0,0 +1,27 @@
|
||||
import time,board
|
||||
|
||||
def Sonar(trig1, echo1):
|
||||
|
||||
trig = board.pin(trig1, board.GPIO.OUT)
|
||||
echo = board.pin(echo1, board.GPIO.IN)
|
||||
time.sleep_ms(10)
|
||||
trig.value(1)
|
||||
time.sleep_us(10)
|
||||
trig.value(0)
|
||||
n1 = time.ticks_us()
|
||||
while(echo.value()==0):
|
||||
n2 =time.ticks_us()
|
||||
if time.ticks_diff(n2, n1) >200000:
|
||||
#raise ValueError("[MixNo]:Sensor read error")
|
||||
break
|
||||
pass
|
||||
t1 = time.ticks_us()
|
||||
while(echo.value()==1):
|
||||
n3 =time.ticks_us()
|
||||
if time.ticks_diff(n3, t1) >200000:
|
||||
#raise ValueError("[MixNo]:Sensor read error")
|
||||
break
|
||||
pass
|
||||
t2 = time.ticks_us()
|
||||
time.sleep_ms(10)
|
||||
return round(time.ticks_diff(t2, t1) / 10000 * 340 / 2, 2)
|
||||
Reference in New Issue
Block a user