DocBrownのブログ -2ページ目

DocBrownのブログ

電子工作等々。。。

超音波距離センサモジュール(HC-SR04)をHUZZAH32で使ってみました。

 

 

接続は以下です。

超音波距離センサモジュールは5Vで動作するのでHUZZAH32の3Vのピンにつなぐと動作しませんでした。

LiPoバッテリを使うときは別で5Vを入力しないといけないかもしれません

 

HC-SR04/HUZZAH32

Vcc⇔USB:赤の線

Trig⇔12番ピン:黄色の線

Echo⇔13番ピン:橙色

Gnd⇔GND:茶色

 

プログラムは以下になります

int Trig = 12; // Echo Pin
int Echo = 13; // Trigger Pin

double Duration;
double Distance;

void setup() {
  Serial.begin(9600);
  Serial.print("START");
  pinMode(Trig,OUTPUT);
  pinMode(Echo,INPUT);
}
void loop() {

  digitalWrite(Trig,LOW);
  delayMicroseconds(2);
  digitalWrite(Trig,HIGH);
  delayMicroseconds(10);
  digitalWrite(Trig,LOW);
  Duration = pulseIn(Echo,HIGH);
  if (Duration>0) {
    Duration = Duration/2;//343.5950188
    Distance = Duration*340*100/1000000; // ultrasonic speed is 340m/s = 34000cm/s = 0.034cm/us 
    Serial.print(Duration);
    Serial.print(" us ");
    Serial.print(Distance);
    Serial.println(" cm");
  }
  delay(500);
}