เนื้อหาของบทความนี้คัดลอกมาจาก facebook ของบริษัท Innovetive Experiment
www.inex.co.th
ก่อนหน้านี้มีการใช้บลูทูธเพื่อควบคุมหุ่นยนต์กันแล้วครับ มาตอนนี้เอาวิธีการง่ายๆ ด้วยการใช้ ZX-SWITCH มาเชื่อมต่อสายโดยตรงเข้ากับตัวหุ่นยนต์กันบ้าง สำหรับคนที่ไม่ต้องการเขียนโปรแกรมที่ซับซ้อนแต่ควบคุมหุ่นยนต์ได้อย่างง่ายๆ
1. นำสวิตช์ ZX-SWITCH มายึดติดเข้ากับแผ่นไม้หรือแผ่นกริด ดังแสดงในรูป โดยสวิตช์ที่ใช้จะมี 6 ตัว
สำหรับเดินหน้า ถอยหลัง เลี้ยวซ้าย เลี้ยวขวา คีบกระป๋อง และปล่อยวางกระป๋อง
สาย JST ขนาด 24 นิ้ว
คอนเน็กเตอร์ JST สำหรับเชื่อมต่อสายสองเส้นเข้าด้วยกัน
2. นำสายไฟแบบ JST ขนาด 24 นิ้ว จำนวนสองเส้นต่อเข้าด้วยกันเพื่อให้ได้ความยาว 48 นิ้ว
3. นำสายไฟเสียบเข้ากับสวิตช์ทั้ง 6 ตัว ส่วนปลายอีกด้านเสียบเข้ากับ POP-BOT XT ในตำแหน่งดังนี้
สวิตช์เดินหน้า ---> ช่อง 18
สวิตช์ถอยหลัง ---> ช่อง 19
สวิตช์เลี้ยวซ้าย ---> ช่อง 20
สวิตช์เลี้ยวขวา ---> ช่อง 21
สวิตช์วางกระป๋อง ---> ช่อง 22
สวิตช์คีบกระป๋อง ---> ช่อง 23
4. ทำการมัดสายให้เรียบร้อย
5 จากนั้นเขียนโปรแกรมทดสอบดังนี้
#include
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");
}
}
ความคิดเห็นนี้ถูกผู้เขียนลบ
ตอบลบความคิดเห็นนี้ถูกผู้เขียนลบ
ตอบลบพี่ผมกดคอนเน็คแล้วมันมีข้อความบบอกแบบนี้ต้องแก้ยังไงคับ
ตอบลบhttp://image.ohozaa.com/view2/xfiWRQ3C4G66ypMo