Sunteți pe pagina 1din 1

// feel free to make changes to improve it or fix problems.

const int Lf=9;//forwards on left


const int Lb= 10;// backwards on left
const int Rf=11;//forwards on right
const int Rb = 12; // backwards on right
int val=0; // store data from sensor
void setup ()
{
pinMode (Lf,OUTPUT); //left motor output
pinMode (Lb,OUTPUT); //left motor output
pinMode (Rf,OUTPUT); //right motor outuput
pinMode (Rb,OUTPUT);// right motor outuput
//analog pins automatically set as input
}
void loop ()
{
val =analogRead (0);//7 reading value of sensor
if (val < 100)
{
digitalWrite (Lf,LOW);// stop going forwards
digitalWrite (Rf,LOW); //stop going forwards
digitalWrite (Lb,HIGH);// back away from object
digitalWrite (Rb,HIGH);// back away from object
delay (2500);
digitalWrite (Rb,LOW);// tum away from objet
delay (2500);
digitalWrite(Lb,LOW);// stop moving
}
else
{
digitalWrite (Lf,HIGH);
digitalWrite (Rf,HIGH);// go forwards if no objet
}
}

S-ar putea să vă placă și