M5STACK(3) 距離の測定

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

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

配線

 HC-SR04M5Stack
1Vcc5V
2Trig2
3Echo5
4GndG

 

スケッチ

#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);
}

結果の表示

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

コメントを残す

メールアドレスが公開されることはありません。