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);
}
結果の表示





