09-26-2014، 04:43 PM
کد پیاچپی:
key = P1;
if((key & 0x40)==0) exit=0;
}
}
Run()
{
char sensors;
sensors = (P3 &=0x0f);
if((sensors & 0x01)==0) {
TurnRight();
flag = 1; }
else if((sensors & 0x08)==0) {
TurnLeft();
flag = 2; }
else if(sensors == 0x09) {
Forward(high);
flag = 0; }
else if(((sensors==0x0b)||(sensors==0x0d))&&(flag==0))
Forward(low);
}
Forward(char speed)
{
P1=0x64;
speedright = speed+10;
speedleft = speed;
delay(time);
}
TurnRight()
{
P1=0x68;
speedright = low+5;
speedleft = low;
delay(time);
}
TurnLeft()
{
P1=0x54;
speedright = low+5;
speedleft = low;
delay(time);
}
Reverse(char speed)
{
P1=0x58;
speedright = speed;
speedleft = speed+5;
delay(time);
}