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

หลบหลีกสิ่งกีดขวางด้วยการชน บอร์ด IPST-SE

หลบหลีกสิ่งกีดขวางด้วยการชน บอร์ด IPST-SE

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

คำสั่งที่ควรทราบหลบหลีกสิ่งกีดขวางด้วยการชน

  • !in(16) สวิตช์ที่เชื่อมกับพอร์ตที่ 16
  • !in(17) สวิตช์ที่เชื่อมกับพอร์ตที่ 17
#include <ipst.h>	// IPST-SE Board
void setup() {
OK();
}

void loop() {
  fd(30);
  if(!in(16))
  {
    bk(30);
    delay(300);
    sr(30);
    delay(500);
    }
  if(!in(17))
  {
    bk(30);
    delay(200);
    sl(30);
    delay(200);
    }
}

 

ใส่ความเห็น

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