วันนี้เราจะมาใช้ Ultrasonic sonser ในการตรวจสอบระยะทางครับ
Module ทีเราจะใช้วันนี้คือเจ้า HC-SR04 เป็นSensor ที่จะปล่อยคลื่น Untrasonic ออกไปและรับกลับมาเพื่อคำนวณหาระยะทางครับโดยเรามีLibrary ให้ครับไม่ต้องคำนวณกันให้วุ่นวาย แต่ถ้าใครสนใจสามารถถามไว้ได้ครับ Project นี้เราจะนำค่าระยะทางมาแสดงออกทาง Serial Port นะครับ
อ่านบทความ : Arduino Projects [EP.5] : Arduino ส่งข้อความออก Serial Port
หน้าตาของ Ultrasonic Sensor HC-SR04 ราคาไม่แพงครับไม่เกิน100บาท
อุปกรณ์
1. Arduino Uno R3
2. Ultrasonic Sensor HC-SR04
การต่อสาย
Source code Arduino HC-SR04
const int TriggerPin = 11; //Trig pin
const int EchoPin = 12; //Echo pin
long Duration = 0;void setup(){
pinMode(TriggerPin,OUTPUT); // Trigger is an output pin
pinMode(EchoPin,INPUT); // Echo is an input pin
Serial.begin(9600); // Serial Output
}void loop(){
digitalWrite(TriggerPin, LOW);
delayMicroseconds(2);
digitalWrite(TriggerPin, HIGH); // Trigger pin to HIGH
delayMicroseconds(10); // 10us high
digitalWrite(TriggerPin, LOW); // Trigger pin to HIGHDuration = pulseIn(EchoPin,HIGH); // Waits for the echo pin to get high
// returns the Duration in microseconds
long Distance_mm = Distance(Duration); // Use function to calculate the distanceSerial.print(“Distance = “); // Output to serial
Serial.print(Distance_mm);
Serial.println(” mm”);delay(1000); // Wait to do next measurement
}long Distance(long time)
{
// Calculates the Distance in mm
// ((time)*(Speed of sound))/ toward and backward of object) * 10long DistanceCalc; // Calculation variable
DistanceCalc = ((time /2.9) / 2); // Actual calculation in mm
//DistanceCalc = time / 74 / 2; // Actual calculation in inches
return DistanceCalc; // return calculated value
}
ผลลัพธ์