超音波距離センサ(HC-SR04)を使った距離計測
https://gyazo.com/52e55063a8167ac49755974e39bedf41
プログラム
code:hcsr04.bas
1 'キョリケイソク
10 CLS
20 P1=PB8:P2=PB3:T=180
30 K=(3315+T*6)/20
40 GPIO P1,OUTPUT
50 GPIO P2,INPUT_FL
60 "loop"
70 OUT P1,LOW
80 OUT P1,HIGH
90 OUT P1,LOW
100 D=PULSEIN(P2,HIGH,200,1)
110 ?DMP$(D/100*K,2)
120 WAIT 300
130 GOTO "loop"
結線
HC-SR04 Trig端子 :PB8(5Vトレラントピン)
HC-SR04 Echo端子 :PB3(5Vトレラントピン)
HC-SR04 GND端子 :GND
HC-SR04 VCC端子 :5V
HC-SR04は5V動作のため、Blue Pillボードで利用するには5V入力可能(5Vトレラント)なピンを利用します。
解説
安価な距離センサ HC-SR04 を使った距離計測のサンプルプログラムです。
PULSEIN()関数を使て、超音波エコーの反射時間を測定しています。
20行の変数Tには、気温(℃)の10倍の値を設定します。
30行で気温を考慮した係数Kを求め、110行でその係数を使って距離を表示しています。
https://www.youtube.com/watch?v=Wpxxxw_aexQ
関連項目
参考資料