การควบคุมหุ่นยนต์ POP-BOT XT ด้วยสวิตช์ 6 ตัว
วิธีการง่ายๆ ในการใช้ ZX-SWITCH มาเชื่อมต่อสายโดยตรงเข้ากับตัวหุ่นยนต์กัน สำหรับคนที่ไม่ต้องการเขียนโปรแกรมที่ซับซ้อน แต่ควบคุมหุ่นยนต์ได้อย่างง่ายๆ 1. นำสวิตช์ ZX-SWITCH มายึดติดเข้ากับแผ่นไม้หรือแผ่นกริด ดังแสดงในรูป โดยสวิตช์ที่ใช้จะมี 6 ตัว สำหรับเดินหน้า ถอยหลัง เลี้ยวซ้าย เลี้ยวขวา คีบกระป๋อง และปล่อยวางกระป๋อง
2. นำสายไฟแบบ JST ขนาด 24 นิ้ว จำนวนสองเส้นต่อเข้าด้วยกันเพื่อให้ได้ความยาว 48 นิ้ว
3. นำสายไฟเสียบเข้ากับสวิตช์ทั้ง 6 ตัว ส่วนปลายอีกด้านเสียบเข้ากับ POP-BOT XT ในตำแหน่งดังนี้ สวิตช์เดินหน้า —> ช่อง 18 สวิตช์ถอยหลัง —> ช่อง 19 สวิตช์เลี้ยวซ้าย —> ช่อง 20 สวิตช์เลี้ยวขวา —> ช่อง 21 สวิตช์วางกระป๋อง —> ช่อง 22 สวิตช์คีบกระป๋อง —> ช่อง 23 4. ทำการมัดสายให้เรียบร้อย
5 จากนั้นเขียนโปรแกรมทดสอบดังนี้
#include <popxt.h> void servo_open(){ servo(2,80);sleep(400);servo(1,140);sleep(400); servo(1,-1);servo(2,-1); } void servo_close(){ servo(1,0);sleep(1000); servo(2,0);sleep(1000); servo(1,-1);servo(2,-1); } void setup(){ glcdMode(1); setTextSize(2); glcd(1,1,"Press OK"); sw_ok_press(); glcdClear(); } void loop(){ if(in(18)==0){ fd(50);glcd(1,1,"Forward "); } else if(in(19)==0){ bk(50);glcd(1,1,"Backward "); } else if(in(20)==0){ sl(50);glcd(1,1,"Spin Left "); } else if(in(21)==0){ sr(50);glcd(1,1,"Spin Right"); } else if(in(22)==0){ servo_open();glcd(1,1,"Servo Open "); } else if(in(23)==0){ servo_close();glcd(1,1,"Servo Close"); } else { ao();glcd(1,1,"Motor Stop"); } }
Facebook Comments Box