รบกวนสอบถามการเขียนโปรแกรม robot เดินตามเส้นหน่อยครับ



คือผมอยากเพิ่มเซ็นเซอร์อีกตัวไว้ตรงกลางระหว่างเซ็นเซอร์สองตัวนั่นอ่ะครับ

เพิ่มไปเพื่อให้ตรวจจับสีแดง ถ้าเจอสีแดงให้สั่งให้โรบอทหยุด ถ้าเอาสีแดงออกให้โรบอททำงานต่อ

ไม่ทราบว่าต้องเพิ่มคำสั่งโปรแกรมอย่างไรครับ ขอบคุณครับ


ส่วนนี่เป็นโค้ทเดิมที่มีครับผม

int pa0 = 0;    // declare variable for the left sensor .
int pa4 = 0;    // declare variable for the right sensor.
int reff = 512; // The difference between white and black. Equal to about 512.  

void setup()  
{
    lcd(" Move follow line.");   // display on lcd.
}

void loop()
{
    pa0 = analog(0); // read analog port 0 and set value to pa0
    pa4 = analog(4); // read analog port 4 and set value to pa4
    
    if( pa4 < reff )        // if the right sensor touch of black line.
    {
        sr(80);             // spin right.  Power 80%
    }
    else if( pa0 < reff )   // if the left sensor touch of black line.
    {
        sl(80);             // spin left. Power 80%
    }
    else                    // if other. Straddling the line.
    {
        fd(100);            // move forward. Power 100%
    }          

    sleep(50);              // wait 50 millisec.
แสดงความคิดเห็น
โปรดศึกษาและยอมรับนโยบายข้อมูลส่วนบุคคลก่อนเริ่มใช้งาน อ่านเพิ่มเติมได้ที่นี่