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 ที่แล้ว
สามารถปรับอัตรมแทร็กให้เหมาะสมในฟังก์ชันต่างๆได้ตามความเหมาะสม สำหรับฟังก์ชันและคำสั่งต่างๆที่ใช้งานเป็นส่วนมาก ที่นี่
4. อัพโหลดโค้ดที่ปรับแต่งเสร็จอีกครั้ง ทดสอบภารกิจ โดยเลือก menu2 ดังวีดีโอสาธิตด้านล่าง