โปรเเกรมควบคุมเซนต์เซอร์วัดระยะ

โปรเเกมควบคุมเซนต์เซอร์วัดระยะ

อุปกรณ์

- บอร์ด nodemcu esp8266

- เซนต์เซอร์วัดระยะ(SONAR)

- สายตัวเมีย-เมีย 4 เส้น

- หลอดไฟ LED

- สายUSB to micro usb

- คอมพิวเตอร์

การเชื่อมต่อ

• VCC เสียบกับ 3V

• GND เสียบกับ GND

• Trin เสียบกับ D1

• echo เสียบกับ D2

โค้ด โปรแกรม

void loop ( ) {

long duration, cm;

pinMode (trig, OUTPUT);

digitalWrite(trig, LOW);

delayMicroseconds (2); digitalWrite(trig, HIGH);

delayMicroseconds (5);

digitalWrite(trig, LOW);

pinMode (echo, INPUT);

duration= pulseIn(echo, HIGH);

cm = microsecondsToCentimeters (duration);

Serial.print(cm);

Serial.print("cm");

Serial.println();

delay(100);

} 

long microsecondsToCentimeters

(long microseconds)

// ความเร็วเสียงในอากาศประมาณ 340 เมตร/วินาที หรือ 29 ไมโครวินาที/เซนติเมตร

// ระยะทางที่ส่งเสียงออกไปจนเสียงสะท้อนกลับมาสามารถใช้หาระยะทางของวัตถุได้

// เวลาที่ใช้คือ ระยะทางไปกลับ ดังนั้นระยะทางคือ ครึ่งหนึ่งของที่วัดได้

return microseconds / 29 / 2;