Lab 7 การแทร็กเส้น V.1

จุดประสงค์การเรียนรู้

สามารถใช้โปรแกรมArduino IDE เขียนแทร็คเส้นได้

เนื้อหา

ก่อนการเขียนโปรแกรมภาษาC++ ในการให้หุ่นยนต์แทร็คเส้น เราควรสร้างอัลกอรึทืมในการเดินทางของหุ่นยนต์เพื่อไม่ให้หลุดเส้น ดังนี้

• เมื่อเซนเซอร์ซ้าย A0 เจอเส้นดำ หุ่นยนต์จะต้องเลี้ยวซ้าย

• เมื่อเซนเซอร์ซ้าย A0 และเซนเซอร์ขวา A2 เจอเส้นขาว หุ่นยนต์จะเดินตรงไปข้างหน้า

• เมื่อเซนเซอร์ขวาA2 เจอเส้นดำ หุ่นยนต์จะต้องเลี้ยวซ้าย

เป้าหมาย

เขียนโปรแกรมภาษาC++ให้ทำการแทร็คเส้นสีดำ

วัสดุอุปกรณ์

1. บอร์ดLotusMegaBot จำนวน 1 ตัว

2. สายMicroUSB จำนวน 1 เส้น

3. โครงหุ่นยนต์ จำนวน 1 ชุด

4. แบตเตอรี Lipo 7.4 V จำนวน 1 ก้อน

วิธีทำ

1. เปิด Arduino IDE แล้วทำการเขียนโค้ดดังภาพข้างล่าง โดยที่หากเขียนโค้ดไว้ในเครื่องหมายปีกกา{} ภายใต้ void setup() โปรแกรมจะทำงานเพียงครั้งเดียว และหากเขียนโค้ดภายในเครื่องหมายปีกกา{} ภายใต้void loop() โปรแกรมจะทำงานต่อเนื่อง

2.ทำการเสียบสายMicroUSBกับบอร์ดLotusMegaBotกับเครื่องคอมพิวเตอร์ ดังรูปข้างล่าง     

3.สำหรับการอัพโหลดโปรแกรมลงบนบอร์ดสามารถทำตามขั้นตอนต่อไปนี้  

ตัวอย่างVDOการทำงานของโปรแกรม