Microcontroller 2

Code โปรเจค Arduino ง่ายๆ เปิด ปิดไฟด้วยเสียง

เปิดปิดไฟด้วยเสียง

เรียนรู้วิธีควบคุม Arduino  ด้วย เซ็นเซอร์เสียง LM393 เราจะควบคุม การ ปิด เปิด ไฟ LED ด้วยเสียงตบมือ โดยเราจะใช้เซ็นเซอร์ตรวจจับเสียง LM393 +  รีเลย์ และแสดงผลด้วยไฟ LED

อุปกรณ์ที่ใช้

1. Arduino UNO R3 - Made in italy

2. Sound Detection Sensor Module LM393

3. สาย Jumper Female to Male ยาว 20cm.

4. สาย Jumper Male to Male ยาว 20cm.

5. Prototype PCB Board 4x6 cm Double Sides

6. สกรูหัวกลม+น็อตตัวเมีย ขนาด 3มม ยาว 12มม

7. Relay 1 Channel DC 5V Module

8. SMD LED Lighting G4 AC DC 12V

9. รางถ่าน AA 8 ก้อน

การต่อวงจร ระหว่าง  เซ็นเซอร์เสียง LM393  กับ Arduino UNO

LM393 <--> UNO

+5V  <--> 5V
GND <--> GND
OUT <--> D4

การต่อวงจร ระหว่าง Relay กับ Arduino UNO

Relay <--> UNO

5V <--> 5V
GND <--> GND
IN <--> D5

การต่อวงจร ระหว่าง UNO+ Relay + LED + รางถ่าน

(LED เป็น LED แบบไม่มีขั้ว ต่อเข้าด้านไหนก็ทำงานได้เช่นกัน)

หมายเหตุ : ที่ 5V ของ Arduino มี 2 สาย จาก เซ็นเซอร์เสียง และ Relay ที่ใช้ร่วม 5V จุดเดียวกัน ให้ เชื่อมต่อ 2 เส้น รวมกันก่อน ให้เหลือ 1 เส้น แล้วจึงเสียบเข้าไปที่ 5V 

เปิดโปรแกรม Arduino (IDE) และ Upload โค้ดนี้ ไปยัง บอร์ด Arduino UNO R3

int sound_sensor = 4;
int relay = 5;

int clap = 0;
long detection_range_start = 0;
long detection_range = 0;
boolean status_lights = false;

void setup() {
  pinMode(sound_sensor, INPUT);
  pinMode(relay, OUTPUT);
}

void loop() {
  int status_sensor = digitalRead(sound_sensor);
  if (status_sensor == 0)
  {
    if (clap == 0)
    {
      detection_range_start = detection_range = millis();
      clap++;
    }
    else if (clap > 0 && millis()-detection_range >= 50)
    {
      detection_range = millis();
      clap++;
    }
  }
  if (millis()-detection_range_start >= 400)
  {
    if (clap == 2)
    {
      if (!status_lights)
        {
          status_lights = true;
          digitalWrite(relay, HIGH);
        }
        else if (status_lights)
        {
          status_lights = false;
          digitalWrite(relay, LOW);
        }
    }
    clap = 0;
  }
}

ให้เอาไขควงหมุน ปรับค่าการรับสัญญาณเสียง ที่ เซ็นเซอร์เสียง LM393 โดยให้หมุนตัว R ปรับค่าได้ แบบ trimpot สีฟ้า โดย เมื่อ ตบมือ 2 ครั้ง ให้ ไฟ LED สีแดง ที่ รีเลย์ ติด และ เมื่อ ตบมืออีก 2 ครั้ง ให้ ไฟ LED สีแดง ที่ รีเลย์ ดับ







ทดสอบการทำงาน โดย  เมื่อไฟติดอยู่ ตบมือ 2 ครั้ง ไฟจะดับ และ เมื่อ ตบมืออีก 2 ครั้ง  ไฟจะติด

Microcontroller 1

Code โปรเจค หุ่นยนต์เดินตามเส้น 2 เซ็นเซอร์ Arduino + L298P

โปรเจค นี้จะเป็นการนำ Arduino UNO R3 + L298P Motor Shield และ เซ็นเซอร์ 1 Channel TCRT5000 Tracker Sensor มาทำเป็น หุ่นยนต์เดินตามเส้น 2 เซ็นเซอร์  โดยให้หุ่นยนต์ตัดสินใจ เดินตามเส้น โดยอัตโนมัติ ด้วยการตรวจจับ เส้นสีดํา พื้นสีขาว

อุปกรณ์ที่ใช้

1. 2WD Smart Car Robot Chassis Kits

2. Arduino UNO R3 - Made in italy

3. L298P Motor Shield Board

4. Jumper (M2M) cable 20cm Male to Male

5. Jumper (F2M) cable 30cm Female to Female

6. สกรูหัวกลม+น็อตตัวเมีย ยาว 12 มม.

7. รางถ่าน 18650 แบบ 2 ก้อน

8. ถ่านชาร์จ 18650 Panasonic NCR18650B 3.7v  จำนวน 2 ก้อน

9. 1 Channel TCRT5000 Tracker Sensor จำนวน 2 ตัว

10. เสารองแผ่นพีซีบีแบบโลหะ ยาว 25 มม.

หลักการทํางานหุ่นยนต์เดินตามเส้น

หุ่นยนต์และมนุษย์มีหลักการทำงานที่เหมือนกัน คือ หน่วยรับข้อมูลเข้า (Input Unit) หน่วยประมวลผล (Process Unit) และหน่วยแสดงผล (Output Unit) ดังนั้นการที่หุ่นยนต์จะเคลื่อนที่ไปให้ตรงเป้าหมาย หุ่นยนต์จะต้องมีอุปกรณ์ที่จะตรวจสอบตำแหน่งและส่งข้อมูลที่ได้ไปยังหน่วยประมวลผล เพื่อให้มอเตอร์ทำการแสดงผลโดยการไปยังเป้าหมายต่อไป อุปกรณ์พื้นฐานที่ใช้ในการตรวจสอบตำแหน่งนั้น คือ โมดูลเซ็นเซอร์แสง TCRT5000 Tracker Sensor

โปรเจค หุ่นยนต์เดินตามเส้น 2 เซ็นเซอร์  Arduino + L298P  นี้ เราจะใช้ 2 เซ็นเซอร์ คือด้านซ้ายและด้านขวา  โดย เมื่อเซ็นเซอร์ ทั้งด้านซ้ายและด้านขวา ตรวจสอบแล้วเป็นพื้นสีขาว ลำแสง สามารถสะท้อนกลับมาได้ทั้งคู่  ( 1 , 1 ) ให้หุ่นยนต์เคลื่อนที่ไปข้างหน้า

หากเซ็นเซอร์ซ้ายมาพบพื้นสีดำ  และ เซ็นเซอร์ขวาพบพื้นสีขาว ( 0 , 1 ) ให้หุ่นยนต์เลี้ยวไปทางด้านซ้าย

หากเซ็นเซอร์ขวามาพบพื้นสีดำ  และ เซ็นเซอร์ซ้ายพบพื้นสีขาว ( 1 , 0 ) ให้หุ่นยนต์เลี้ยวไปทางด้านขวา

หากเซ็นเซอร์ทั้งสองมาอยู่บนเส้นสีดำทั้งคู่ ( 0 , 0 ) ให้หุ่นยนต์หยุด

ประกอบ เซ็นเซอร์ 1 Channel TCRT5000


ใช้ จั้มเปอร์ เมีย-เมีย 30cm เชื่อมต่อ เซ็นเซอร์ ทั้ง 2 ตัว เข้ากับ L298P ตามรูปด้านล่าง 

เซ็นเซอร์ (ซ้าย) <-> L298P

GND <-> GND

VCC <-> +5

OUT <-> A0

เซ็นเซอร์ (ขวา) <-> L298P

GND <-> GND

VCC <-> +5

OUT <-> A1 

ภาพรวมการเชื่อมต่อระหว่าง L298P กับ เซ็นเซอร์ ด้านซ้ายและด้านขวา

การเชื่อมต่อสายที่ A0 และ A1

ด้านขวาของหุ่นยนต์

ด้านล่างของหุ่นยนต์

ด้านหน้าของหุ่นยนต์

จากนั้นใช้สาย USB เชื่อมต่อระหว่าง คอมพิวเตอร์ กับ Arduino UNO R3

 เปิดโปรแกรม Arduino (IDE) และ Upload โค้ดนี้ ไปยัง บอร์ด Arduino UNO R3

/*
  read analog data from A0-A1 and send to PC via Serial port
*/

int sensor_L , sensor_R ; //optical sensor values
String tmp ;
int ADC_stabilize = 5 ;

void setup ( ) {
  // initialize the serial communication:
  Serial . begin ( 9600 ) ;
}

void loop ( ) {
  //take a snapshot
  sensor_L = digitalRead ( A0 ) ;
  delay ( ADC_stabilize ) ; //stabilize
  sensor_L = digitalRead ( A0 ) ;
  delay ( ADC_stabilize ) ;

  sensor_R = digitalRead ( A1 ) ;
  delay ( ADC_stabilize ) ;
  sensor_R = digitalRead ( A1 ) ;
  delay ( ADC_stabilize ) ;

  tmp = "L=" + String ( sensor_L ) +  " R=" + String ( sensor_R ) ;

  // send the value of analog inputs:
  Serial . println ( tmp ) ;

  // wait a bit for next reading
  delay ( 1000 ) ; //1000=1 sec

}

วีดีโอผลลัพธ์ หุ่นยนต์เดินตามเส้น 2 เซ็นเซอร์  Arduino + L298P

https://youtu.be/gjOz3dwWpPE