วิชาการเขียนโปรแกรมควบคุมหุ่นยนต์

การรวมคำสั่ง บอร์ด ipst อย่างง่าย

ในการเขียนคำสั่งควบคุมบอร์ด ipst นั้นหากเราไม่มีการรวมคำสั่งต่าง ๆ จะส่งผลให้ผู้เขียนคำสั่งจะต้องเขียนคำสั่งที่ยาวมาก ๆ เมื่อมีการเรียกใช้งานคำสั่งเดิม ๆ ก็จะต้องเขียนโค้ดเดิม ๆ ซึ่งหากเรามีการจัดชุดคำสั่งเป็นกลุ่มก้อน ให้อยู่ใน void จะดีต่อผู้เขียนคำสั่งเวลาเรียกใช้คำสั่งเดิม ดังตัวอย่างที่แสดง

ข้อดีของการเรียกรวมคำสั่ง

  1. เขียนโค้ดสั้นลง
  2. ลดข้อผิดพลาดในการอ่านคำสั่งของบอร์ด ipst
  3. เมื่อมีข้อผิดพลาดเราสามารถหาจุดผิดพลาดได้ง่าย

การรวมคำสั่ง บอร์ด ipst

#include <ipst.h>
void LLL(){     //เป็นการประกาศชุดคำสั่ง จัดกลุ่มให้อยู่ใน void LLL
 int L,R,CL=585,CR=601;
 while(1){
 L=analog(0); R=analog(1);
 if(L>CL&&R>CR) { fd(40); }
 else if(L<CL&&R>CR) { sl(40); }
 else if(L>CL&&R<CR) { sr(40); }
 else if(L<CL&&R<CR) {
 fd(40);
 while(analog(0)>CL){ sl(30); }
 while(analog(0)<CL){ sl(30); }
 break;
 }
 }
}
void RRR(){    //เป็นการประกาศชุดคำสั่ง จัดกลุ่มให้อยู่ใน void RRR
 int L,R,CL=585,CR=601;
 while(1){
 L=analog(0); R=analog(1);
 if(L>CL&&R>CR) { fd(40); }
 else if(L<CL&&R>CR) { sl(40); }
 else if(L>CL&&R<CR) { sr(40); }
 else if(L<CL&&R<CR){
 fd(40); 
 while(analog(1)>CR){ sr(30); }
 while(analog(1)<CR){ sr(30); }
 break;
 }
 }
}
void setup(){
 OK();
}
void loop(){
  RRR();RRR(); LLL();LLL();   //เรียกใช้ชุดคำสั่ง ที่เราได้สร้างอยู่ในชุดคำสั่งจากด้านบน
}

 

ใส่ความเห็น

อีเมลของคุณจะไม่แสดงให้คนอื่นเห็น ช่องข้อมูลจำเป็นถูกทำเครื่องหมาย *