|
|
鞋碼匹配儀，利用超聲波測距的原理。通過使用超聲波遇到障礙返回的特性，計(jì)算超聲波放出與返回的時(shí)間計(jì)算來測定障礙與超聲波模塊的距離。
鞋碼匹配儀的固有大小已知，在腳放入時(shí)，大小會(huì)發(fā)生改變 使用已知距離對改變后的距離做差獲得腳的尺寸，再通過尺寸與距離的轉(zhuǎn)換得到正確的鞋碼（此處使用標(biāo)準(zhǔn)鞋碼）。
1. 所需元器件
超聲波模塊 1個(gè)
TPYBoard v102板子 1塊
四位數(shù)碼管 1個(gè)
micro USB數(shù)據(jù)線 1條
杜邦線 若干
2. 超聲波模塊工作原理
(1)采用IO口TRIG觸發(fā)測距，給最少10us的高電平信號(hào)。
(2)模塊自動(dòng)發(fā)送 8 個(gè) 40khz 的方波，自動(dòng)檢測是否有信號(hào)返回。
(3)有信號(hào)返回，通過 IO 口 ECHO 輸出一個(gè)高電平，高電平持續(xù)的時(shí)間就是超聲波從發(fā)射到返回的時(shí)間。測試距離=(高電平時(shí)間*聲速(340M/S))/2。
如下圖接線，VCC 供 5V電源， GND 為地線，TRIG 觸發(fā)控制信號(hào)輸入，ECHO 回響信號(hào)輸出等四個(gè)接口端。
3. 控制四位數(shù)碼管顯示數(shù)字
（1）1、2、3、4是“位選”針腳，用于控制具體哪一位顯示。
（2）a、b、c、d、e、f、g、dp（h）是“段選”針腳，用法和1位數(shù)碼管一致，用來顯示具體的數(shù)值。
4. 接線圖
5. 源代碼
- import pyb
- from pyb import Pin
- from pyb import Timer
- from machine import SPI,Pin
-
- Trig = Pin('X2',Pin.OUT_PP)
- Echo = Pin('X1',Pin.IN)
- num=0
- flag=0
- run=1
- def start(t):
- global flag
- global num
- if(flag==0):
- num=0
- else:
- num=num+1
- def stop(t):
- global run
- if(run==0):
- run=1
- start1=Timer(1,freq=10000,callback=start)
- stop1=Timer(4,freq=2,callback=stop)
-
- sizecc = [35,36,37,38,39,40,41,42,43,44,45,46,47]#280-47 -5
- while True:
- if(run==1):
- Trig.value(1)
- pyb.udelay(100)
- Trig.value(0)
- while(Echo.value()==0):
- Trig.value(1)
- pyb.udelay(100)
- Trig.value(0)
- flag=0
- if(Echo.value()==1):
- flag=1
- while(Echo.value()==1):
- flag=1
- if(num!=0):
- #print('num:',num)
- distance=num/1000*34000/2
- print('Distance')
- print(distance,'mm')
- cc = (int)((distance-215)/5)
- if cc<0:
- cc=0
- elif cc>12:
- cc=12
- print(sizecc[cc],'cc')
- flag=0
- run=0
|
|
