HC-SR04 โมดูลวัดระยะทางด้วยอัลตร้าโซนิก
เป็นโมดูลวัดระยะทางที่ใช้หลักการสะท้อนของคลื่นอัลตร้าโซนิก ราคาประหยัด
มาพร้อมกับสาย สัญญาณเพื่อใช้เชื่อมต่อกับบอร์ดต่างๆ ตามมาตฐานของ inex ไม่ว่าจะเป็น POP-BOT XT , Robo-Creator หรือ IPST-SE สำหรับตัวอย่างการเชื่อมต่อกับหุ่นยนต์รุ่น Robo-Creator ทำได้ดังนี้
1. เตรียมสายสัญญาณ
สายสัญญาณที่ใช้กับโมดูล HC-SR04 ปลายด้านหนึ่งจะใช้เชื่อมต่อกับบอร์ด Robo-Creator ได้ทันที ส่วนปลายอีกด้านจะต้องเลือกเชื่อมต่อ โดยสีของสายจะเป็นตัวบอกหน้าที่ตามรูป (การต่อสายผิดอาจจะทำให้โมดูล HC-SR04 เสียหายได้)
2. ขาเชื่อมต่อของโมดูล HC-SR04
โมดูล HC-SR04 มีขาเชื่อมต่อทั้งหมด 4 เส้นคือ
- ขา Vcc : เป็นขาไฟเลี้ยง +5V
- ขา Trig : เป็นขาส่งสัญญาณ
- ขา Echo : เป็นขารับสัญญาณ
- ขา Gnd : เป็นขากราวด์
3. ตัดสายสัญญาณออกด้านละ 1 เส้นเพื่อลดความสับสน
สายที่ให้มาในชุดมีสองเส้น เส้นละ 3 สาย แต่จุดต่อเชื่อมต่อมีเพียง 4 สาย ดังนั้นต้องตัดออก 2 เส้น โดยเส้นแรกให้ตัดสายสีดำทิ้ง ส่วนเส้นที่ 2 ให้ตัดสายสีแดงทิ้ง แต่ถ้าไม่ต้องการตัด อาจจะถอดจุดต่อที่ส่วนหัวของขั้วต่อ JST เพื่อเอาสายออกมา 1 เส้นก็ได้ ดังรูป
4. ต่อสายเข้ากับโมดูล HC-SR04
นำสายที่ตัดออกแล้ว เหลือปลาย 4 เส้นเสียบเข้าที่โมดูล HC-SR04 ดังรูป
5. เชื่อมต่อสายเข้ากับบอร์ด Robo-Creator
- ขา Trig ต่อเข้ากับขา 1
- ขา Echo ต่อเข้ากับขา 0
6. เขียนโปรแกรมเพื่ออ่านค่าแสดงที่หน้าจอ LCD
#include <atx.h> #define TRIG 1 #define ECHO 0 long RAW; float DIST; void setup(){ lcd("SW1 Press!"); sw1_press(); } void loop() { out(TRIG,HIGH); delayMicroseconds(10); out(TRIG, LOW); RAW=pulseIn(ECHO,HIGH); DIST=(float(RAW)/2)/29.1; lcd("RAW=%l ",RAW); lcd("#nDIST=%f CM ",DIST); delay(300); }
Facebook Comments Box