超音波距離センサモジュール(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);
}
