Lab 13 KB-IDE-Line Tracing EP2

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

1. สามารถเขียนCodeในKB-IDE วัดค่าความเข้มแสงจากพื้นและเส้นสี จากสัญญาณAnalogได้

2. สามารถเขียนCodeในKB-IDEควบคุมการทำงานของหุ่นยนต์อัตโนมัติในการแทร็กเส้นแบบสนามตารางภารกิจได้

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

1. บอร์ดLotus Devkit V.1.0 จำนวน 1 ตัว

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

3.Servo Motor จำนวน 1 ตัว

4.DC Motor จำนวน 2 ตัว

5.Battery Lipo 7.4Vdc จำนวน 1 ก้อน

6. เซนเซอร์แทร็กเส้นAnalog Lotus T3 จำนวน 4 ตัว

วิธีทดลอง

เป้าหมายในการทำงานของLabนี้ เพื่อเขียนโปรแกรมให้หุ่นยนต์อ่านค่าแสงจากพื้นสนามได้ และเขียนโค้ดให้หุ่นยนต์สามารถแทร็กเส้นแบบสนามตารางภารกิจได้

1. ทำการเซนเซอร์ Lotus T3 ดังรูปข้างล่าง

2. ทำการเขียนโค้ดข้างล่าง และอัพโหลดโค้ดลงบนบอร์ด

สำหรับตัวอย่างโค้ดสามารถดาวน์โหลดได้ที่ : https://drive.google.com/file/d/1ZIRWbJvayTJKM8HT9BEByXNPyI9hXCPp/view?usp=sharing

ตัวอย่างอัลกอริทึมในการแทร็กเส้น มีดังนี้

3. เรียก Menu 0 มาทำการวัดค่าแสง สีพื้น และสีเส้นที่ต้องการจะแทร็ก มาหาค่าเฉลี่ยและกรอกไปที่บล็อกส่วน Setup เหมือนกับ Lab ที่แล้ว

สามารถปรับอัตรมแทร็กให้เหมาะสมในฟังก์ชันต่างๆได้ตามความเหมาะสม สำหรับฟังก์ชันและคำสั่งต่างๆที่ใช้งานเป็นส่วนมาก ที่นี่

KB-IDE Line Tracing ภารกิจ คำสั่ง

4. อัพโหลดโค้ดที่ปรับแต่งเสร็จอีกครั้ง ทดสอบภารกิจ โดยเลือก menu2 ดังวีดีโอสาธิตด้านล่าง

Page updated

Report abuse