8
digitalWrite(revright6,LOW);
digitalWrite(fwdleft5,HIGH);
digitalWrite(revleft4,LOW);
analogWrite(enright,135);//Runin
halfspeed
analogWrite(enleft,135);//Runin
halfspeed
}
if(cm<20)//ConditionForPresence
OfObstacle
{
digitalWrite(fwdright7,LOW);//Stop
digitalWrite(revright6,LOW);
digitalWrite(fwdleft5,LOW);
digitalWrite(revleft4,LOW);
delay(500);
digitalWrite(fwdright7,LOW);//
MoveBackward
digitalWrite(revright6,HIGH);
digitalWrite(fwdleft5,LOW);
digitalWrite(revleft4,HIGH);
delay(500);
digitalWrite(fwdright7,LOW);//Stop
digitalWrite(revright6,LOW);
digitalWrite(fwdleft5,LOW);
digitalWrite(revleft4,LOW);
delay(100);
checkLeftDistance();
delay(20);
checkRightDistance();
delay(20);
if(cm2>cm3)
{
digitalWrite(fwdright7,HIGH);//
MoveLeft
digitalWrite(revright6,LOW);
digitalWrite(revleft4,LOW);
digitalWrite(fwdleft5,LOW);
}
elseif(cm3>cm2)
{
digitalWrite(fwdright7,LOW);//
MoveRight
digitalWrite(revright6,LOW);
digitalWrite(revleft4,HIGH);
digitalWrite(fwdleft5,LOW);
}
else
{
digitalWrite(fwdright7,HIGH);//
MoveLeft
digitalWrite(revright6,LOW);
digitalWrite(revleft4,LOW);
digitalWrite(fwdleft5,LOW);
}
delay(500);
}
}
voidcheckLeftDistance()
{
digitalWrite(trigPin2,LOW);
delayMicroseconds(4);
digitalWrite(trigPin2,HIGH);
delayMicroseconds(10);
digitalWrite(trigPin2,LOW);
duration2=pulseIn(echoPin2,HIGH);
cm2=(duration2/2)/29.1;
Serial.print("Leftdistance:");