Page 138 - ArduinoและPOP-BOT

138

void loop()
{
motor_stop(ALL);
servo(7,posValue[0]);
for(j=0;j<9;j++)
{
servo(7,posValue[j]);
GP2[j]=getdist(5);
sleep(100);
}
MinPoint = getPoint();
if(Minimum>32)
{
turn_right(150);
sleep(600);
}
else if(Minimum<8)
{
servo(7,posValue[getPoint()]);
beep();
while(1);
}
else
{
switch(MinPoint)
{
case 0: turn_right(320);
forward(400-Minimum);
break;
case 1: turn_right(240);
forward(400-Minimum);
break;
case 2: turn_right(160);
forward(400-Minimum);
break;
case 3: turn_right(80);
forward(400-Minimum);
break;
case 4: turn_right(0);
forward(400-Minimum);
break;
case 5: turn_left(80);
forward(400-Minimum);
break;
case 6: turn_left(160);
forward(400-Minimum);
break;
case 7: turn_left(240);
forward(400-Minimum);
break;
case 8: turn_left(320);
forward(400-Minimum);
break;
}
}
}

โปรแกรมที่ A11-1 ไฟล BallSeekerRobot.pde โปรแกรมภาษา C ของ Arduino สํ าหรั บ

ตามหาลู กบอลของหุ นยนต POP-BOT (จบ)