HC-SR04 โมดูลวัดระยะทางด้วยอัลตร้าโซนิก
เป็นโมดูลวัดระยะทางที่ใช้หลักการสะท้อนของคลื่นอัลตร้าโซนิก ราคาประหยัด
มาพร้อมกับสาย สัญญาณเพื่อใช้เชื่อมต่อกับบอร์ดต่างๆ ตามมาตฐานของ inex ไม่ว่าจะเป็น POP-BOT XT , Robo-Creator หรือ IPST-SE สำหรับตัวอย่างการเชื่อมต่อกับหุ่นยนต์รุ่น Robo-Creator ทำได้ดังนี้
1. เตรียมสายสัญญาณ
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
#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);
}
ไม่มีความคิดเห็น:
แสดงความคิดเห็น