距離センサを使ってみた

概要

距離センサを購入したので試してみました。

部品

距離センサ:HC-SR04
83円

※参考にしたSwitchScienceによるとこれには一部欠陥があるようで、そちらのほうが良いかもしれません。

表示機:TM1637が組み込まれた7セグLED
73円

コンピュータ:Arduino UNO互換機
699円

#配線

Triggerを10マイクロ秒以上 UPさせると、40kHzで８回距離を測り、その結果をEchoに周波数で返す仕様らしいです。

#ソースコード

  
#include <Arduino.h>  
#include <TM1637Display.h>  
#include <Wire.h>  
  
#define SERIAL_BAUD 115200  
#define CLK 2  
#define DIO 3  
TM1637Display display(CLK, DIO);  
int Trig = 5;  
int Echo = 4;  
  
void setup() {  
  Serial.begin(SERIAL_BAUD);  
  while(!Serial) {}  
   pinMode(Trig,OUTPUT);  
   pinMode(Echo,INPUT);  
  
  Wire.begin();  
  uint8_t data[] = { 0xff, 0xff, 0xff, 0xff };  
  display.setBrightness(0x0f);  
  display.setSegments(data);  
  delay(1000);  
}  
  
void loop() {  
  int Duration;  
  float Distance;  
    digitalWrite(Trig,LOW);  
    delayMicroseconds(1);  
    digitalWrite(Trig,HIGH);  
    delayMicroseconds(11);  
    digitalWrite(Trig,LOW);  
    Duration = pulseIn(Echo,HIGH);  
    if (Duration>0) {  
      Distance = Duration/2;  
      Distance = Distance*340*100/1000000; // 340m/s = 34000cm/s = 0.034cm/us   
      Serial.print(Distance);  
      Serial.println(" cm");  
      display.showNumberDec((unsigned int)(Distance*100), false);  
//      analogWrite(11, (unsigned int)(100-Distance));//ビープ音  
    }  
  delay(100);  
}  

github

動作確認

gif動画で上げても分かりにくかったので、Youtubeにて確認いただけると幸いです。