ระบุ ข้อมูล พื้นฐาน ของ หุ่น ยนต์ pop bot xt

เนื้อหาของบทความนี้คัดลอกมาจาก facebook ของบริษัท Innovetive Experiment 
www.inex.co.th

ก่อนหน้านี้มีการใช้บลูทูธเพื่อควบคุมหุ่นยนต์กันแล้วครับ มาตอนนี้เอาวิธีการง่ายๆ ด้วยการใช้ ZX-SWITCH มาเชื่อมต่อสายโดยตรงเข้ากับตัวหุ่นยนต์กันบ้าง สำหรับคนที่ไม่ต้องการเขียนโปรแกรมที่ซับซ้อนแต่ควบคุมหุ่นยนต์ได้อย่างง่ายๆ

ยึดแผงวงจรสวิตช์เข้ากับแผ่นกริด

1. นำสวิตช์ ZX-SWITCH มายึดติดเข้ากับแผ่นไม้หรือแผ่นกริด ดังแสดงในรูป โดยสวิตช์ที่ใช้จะมี 6 ตัว

สำหรับเดินหน้า ถอยหลัง  เลี้ยวซ้าย เลี้ยวขวา  คีบกระป๋อง และปล่อยวางกระป๋อง 

สาย JST ขนาด 24 นิ้ว

คอนเน็กเตอร์ JST สำหรับเชื่อมต่อสายสองเส้นเข้าด้วยกัน

เชื่อมต่อสายยาวรวม 48 นิ้ว

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");

} 

}

ใส่ความเห็น

Enter your comment here...

Fill in your details below or click an icon to log in:

อีเมล (ต้องการ) (Address never made public)

ชื่อ (ต้องการ)

เว็บไซต์

You are commenting using your WordPress.com account. ( Log Out /  เปลี่ยนแปลง )

You are commenting using your Twitter account. ( Log Out /  เปลี่ยนแปลง )

You are commenting using your Facebook account. ( Log Out /  เปลี่ยนแปลง )

ยกเลิก

Connecting to %s

Notify me of new comments via email.

Notify me of new posts via email.

Δ