[HC-SR04] [ATX] with Robo-Creator

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