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

ควบคุมหุ่นยนต์ให้เดินเลี้ยวซ้าย หรือขวา

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

ตัวอย่างโค้ดอย่างง่ายเลี้ยวซ้าย หรือขวา

  • มอเตอร์ ตัวที่ 1 อยู่ด้านซ้าย
  • มอเตอร์ตัวที่ 2 อยู่ด้านขวา

#โค้ดตัวอย่างที่แสดง หุ่นของครูจะเลี้ยวไปทางซ้าย นะครับ

#include <ipst.h>
void setup()
{
  setTextSize(3);     
  glcd (0,0,"ok"); 
  }
void loop()
{
  if (sw_OK()) 
  {
  motor(1,0);  // ขับมอเตอร์ข้างที่ 1 ด้วยกำลังไฟ 0 (มากสุดคือ 100) 
  motor(2,40);  // ขับมอเตอร์ข้างที่ 2 ด้วยกำลังไฟ 40 (มากสุดคือ 100)
  delay(1300);  //เวลาในการขับมอเตอร์    
  /* เวลา 1000 เท่ากับ 1 วินาที (มอเตอร์ทำงาน 1.3 วินาที)ทำมุม 90 องศา
  ทั้งนี้นทั้งนั้นขึ้นอยู่กับพื้นกับล้อกับหลาย ๆ อย่างร่วมด้วย*/
  }
}

อธิบายเพิ่ม เติ่มความรู้

ในการสั่งให้หุ่นของเราเลี้ยวซ้ายหรือขวานั้น ตัวเราเองต้องรู้ว่ามอเตอร์แต่ละตัวอยู่ด้านไหน เช่นหากมอเตอร์ที่ 1 อยู่ด้านซ้าย แล้วเมื่อเราต้องการให้หุ่นเลี้ยวไปทางซ้าย เราจะต้องสั่งให้มอเตอร์ตัวที่ 2 ทำงาน โดยที่มอเตอร์ตัวที่ 1 ไม่ต้องทำงาน 

หากจะให้เลี้ยวไปทางด้านขวาก็เขียนโค้ดให้ตรงกันข้ามกับการเลี้ยวซ้าย

กดย้อนกลับเพื่อเข้าไปยังหน้าหลักของวิชาการเขียนโปรแกรมควบคุมหุ่นยนต์ IPST –>click

 

ใส่ความเห็น

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