M5STACK(3) 距離の測定
超音波を使って距離を測定するセンサー SR04とM5Stackを接続し、距離を計測してみました。
配線
HC-SR04 | M5Stack | |
---|---|---|
1 | Vcc | 5V |
2 | Trig | 2 |
3 | Echo | 5 |
4 | Gnd | G |
スケッチ
#include <M5Stack.h> #define TRIG 2 #define ECHO 5 int tt; int kyori; void setup() { M5.begin(); pinMode(TRIG, OUTPUT); pinMode(ECHO, INPUT); // 文字サイズ M5.Lcd.setTextSize(10); } void loop() { // 超音波を発生させる digitalWrite(TRIG, HIGH); delayMicroseconds(10); digitalWrite(TRIG, LOW); // 超音波を受け取る tt = pulseIn(ECHO, HIGH); kyori = (int)(tt * 100/578); // ディスプレイに表示させる M5.Lcd.fillScreen(BLACK); M5.Lcd.setCursor(50, 100); M5.Lcd.printf("%4d",kyori); M5.Lcd.print("mm"); delay(700); }