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