M5STACK(3) 距離の測定

ブログランキング・にほんブログ村へ

超音波を使って距離を測定するセンサー SR04とM5Stackを接続し、距離を計測してみました。

配線

 

スケッチ

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
#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);
}

結果の表示

ブログランキング・にほんブログ村へ

  • X

コメントを残す

メールアドレスが公開されることはありません。 が付いている欄は必須項目です